^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1) /*******************************************************************
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2) *
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3) * Copyright (c) 2000 ATecoM GmbH
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 4) *
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 5) * The author may be reached at ecd@atecom.com.
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 6) *
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 7) * This program is free software; you can redistribute it and/or modify it
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 8) * under the terms of the GNU General Public License as published by the
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 9) * Free Software Foundation; either version 2 of the License, or (at your
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 10) * option) any later version.
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 11) *
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 12) * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 13) * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 14) * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 15) * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 16) * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 17) * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 18) * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 19) * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 20) * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 21) * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 22) *
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 23) * You should have received a copy of the GNU General Public License along
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 24) * with this program; if not, write to the Free Software Foundation, Inc.,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 25) * 675 Mass Ave, Cambridge, MA 02139, USA.
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 26) *
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 27) *******************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 28)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 29) #include <linux/module.h>
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 30) #include <linux/pci.h>
3c6b377321678 (Randy Dunlap 2006-07-03 19:48:25 -0700 31) #include <linux/poison.h>
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 32) #include <linux/skbuff.h>
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 33) #include <linux/kernel.h>
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 34) #include <linux/vmalloc.h>
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 35) #include <linux/netdevice.h>
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 36) #include <linux/atmdev.h>
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 37) #include <linux/atm.h>
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 38) #include <linux/delay.h>
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 39) #include <linux/init.h>
a6b7a407865aa (Alexey Dobriyan 2011-06-06 10:43:46 +0000 40) #include <linux/interrupt.h>
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 41) #include <linux/bitops.h>
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 42) #include <linux/wait.h>
e1bd232b641a0 (Marcelo Feitoza Parisi 2005-07-19 13:55:14 -0700 43) #include <linux/jiffies.h>
7e7a2d07b0faf (Matthias Kaehlcke 2007-05-23 14:45:45 -0700 44) #include <linux/mutex.h>
5a0e3ad6af866 (Tejun Heo 2010-03-24 17:04:11 +0900 45) #include <linux/slab.h>
7e7a2d07b0faf (Matthias Kaehlcke 2007-05-23 14:45:45 -0700 46)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 47) #include <asm/io.h>
7c0f6ba682b9c (Linus Torvalds 2016-12-24 11:46:01 -0800 48) #include <linux/uaccess.h>
60063497a95e7 (Arun Sharma 2011-07-26 16:09:06 -0700 49) #include <linux/atomic.h>
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 50) #include <asm/byteorder.h>
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 51)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 52) #ifdef CONFIG_ATM_IDT77252_USE_SUNI
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 53) #include "suni.h"
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 54) #endif /* CONFIG_ATM_IDT77252_USE_SUNI */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 55)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 56)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 57) #include "idt77252.h"
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 58) #include "idt77252_tables.h"
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 59)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 60) static unsigned int vpibits = 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 61)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 62)
44beac008631d (Robert P. J. Day 2007-07-16 18:35:07 -0700 63) #define ATM_IDT77252_SEND_IDLE 1
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 64)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 65)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 66) /*
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 67) * Debug HACKs.
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 68) */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 69) #define DEBUG_MODULE 1
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 70) #undef HAVE_EEPROM /* does not work, yet. */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 71)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 72) #ifdef CONFIG_ATM_IDT77252_DEBUG
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 73) static unsigned long debug = DBG_GENERAL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 74) #endif
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 75)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 76)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 77) #define SAR_RX_DELAY (SAR_CFG_RXINT_NODELAY)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 78)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 79)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 80) /*
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 81) * SCQ Handling.
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 82) */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 83) static struct scq_info *alloc_scq(struct idt77252_dev *, int);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 84) static void free_scq(struct idt77252_dev *, struct scq_info *);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 85) static int queue_skb(struct idt77252_dev *, struct vc_map *,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 86) struct sk_buff *, int oam);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 87) static void drain_scq(struct idt77252_dev *, struct vc_map *);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 88) static unsigned long get_free_scd(struct idt77252_dev *, struct vc_map *);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 89) static void fill_scd(struct idt77252_dev *, struct scq_info *, int);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 90)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 91) /*
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 92) * FBQ Handling.
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 93) */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 94) static int push_rx_skb(struct idt77252_dev *,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 95) struct sk_buff *, int queue);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 96) static void recycle_rx_skb(struct idt77252_dev *, struct sk_buff *);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 97) static void flush_rx_pool(struct idt77252_dev *, struct rx_pool *);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 98) static void recycle_rx_pool_skb(struct idt77252_dev *,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 99) struct rx_pool *);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 100) static void add_rx_skb(struct idt77252_dev *, int queue,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 101) unsigned int size, unsigned int count);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 102)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 103) /*
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 104) * RSQ Handling.
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 105) */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 106) static int init_rsq(struct idt77252_dev *);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 107) static void deinit_rsq(struct idt77252_dev *);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 108) static void idt77252_rx(struct idt77252_dev *);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 109)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 110) /*
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 111) * TSQ handling.
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 112) */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 113) static int init_tsq(struct idt77252_dev *);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 114) static void deinit_tsq(struct idt77252_dev *);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 115) static void idt77252_tx(struct idt77252_dev *);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 116)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 117)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 118) /*
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 119) * ATM Interface.
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 120) */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 121) static void idt77252_dev_close(struct atm_dev *dev);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 122) static int idt77252_open(struct atm_vcc *vcc);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 123) static void idt77252_close(struct atm_vcc *vcc);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 124) static int idt77252_send(struct atm_vcc *vcc, struct sk_buff *skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 125) static int idt77252_send_oam(struct atm_vcc *vcc, void *cell,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 126) int flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 127) static void idt77252_phy_put(struct atm_dev *dev, unsigned char value,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 128) unsigned long addr);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 129) static unsigned char idt77252_phy_get(struct atm_dev *dev, unsigned long addr);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 130) static int idt77252_change_qos(struct atm_vcc *vcc, struct atm_qos *qos,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 131) int flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 132) static int idt77252_proc_read(struct atm_dev *dev, loff_t * pos,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 133) char *page);
c4028958b6eca (David Howells 2006-11-22 14:57:56 +0000 134) static void idt77252_softint(struct work_struct *work);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 135)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 136)
46c4b7a5694cc (Bhumika Goyal 2017-08-09 14:49:15 +0530 137) static const struct atmdev_ops idt77252_ops =
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 138) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 139) .dev_close = idt77252_dev_close,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 140) .open = idt77252_open,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 141) .close = idt77252_close,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 142) .send = idt77252_send,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 143) .send_oam = idt77252_send_oam,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 144) .phy_put = idt77252_phy_put,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 145) .phy_get = idt77252_phy_get,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 146) .change_qos = idt77252_change_qos,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 147) .proc_read = idt77252_proc_read,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 148) .owner = THIS_MODULE
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 149) };
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 150)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 151) static struct idt77252_dev *idt77252_chain = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 152) static unsigned int idt77252_sram_write_errors = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 153)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 154) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 155) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 156) /* I/O and Utility Bus */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 157) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 158) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 159)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 160) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 161) waitfor_idle(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 162) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 163) u32 stat;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 164)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 165) stat = readl(SAR_REG_STAT);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 166) while (stat & SAR_STAT_CMDBZ)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 167) stat = readl(SAR_REG_STAT);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 168) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 169)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 170) static u32
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 171) read_sram(struct idt77252_dev *card, unsigned long addr)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 172) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 173) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 174) u32 value;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 175)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 176) spin_lock_irqsave(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 177) writel(SAR_CMD_READ_SRAM | (addr << 2), SAR_REG_CMD);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 178) waitfor_idle(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 179) value = readl(SAR_REG_DR0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 180) spin_unlock_irqrestore(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 181) return value;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 182) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 183)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 184) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 185) write_sram(struct idt77252_dev *card, unsigned long addr, u32 value)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 186) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 187) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 188)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 189) if ((idt77252_sram_write_errors == 0) &&
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 190) (((addr > card->tst[0] + card->tst_size - 2) &&
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 191) (addr < card->tst[0] + card->tst_size)) ||
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 192) ((addr > card->tst[1] + card->tst_size - 2) &&
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 193) (addr < card->tst[1] + card->tst_size)))) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 194) printk("%s: ERROR: TST JMP section at %08lx written: %08x\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 195) card->name, addr, value);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 196) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 197)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 198) spin_lock_irqsave(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 199) writel(value, SAR_REG_DR0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 200) writel(SAR_CMD_WRITE_SRAM | (addr << 2), SAR_REG_CMD);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 201) waitfor_idle(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 202) spin_unlock_irqrestore(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 203) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 204)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 205) static u8
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 206) read_utility(void *dev, unsigned long ubus_addr)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 207) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 208) struct idt77252_dev *card = dev;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 209) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 210) u8 value;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 211)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 212) if (!card) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 213) printk("Error: No such device.\n");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 214) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 215) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 216)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 217) spin_lock_irqsave(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 218) writel(SAR_CMD_READ_UTILITY + ubus_addr, SAR_REG_CMD);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 219) waitfor_idle(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 220) value = readl(SAR_REG_DR0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 221) spin_unlock_irqrestore(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 222) return value;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 223) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 224)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 225) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 226) write_utility(void *dev, unsigned long ubus_addr, u8 value)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 227) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 228) struct idt77252_dev *card = dev;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 229) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 230)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 231) if (!card) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 232) printk("Error: No such device.\n");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 233) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 234) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 235)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 236) spin_lock_irqsave(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 237) writel((u32) value, SAR_REG_DR0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 238) writel(SAR_CMD_WRITE_UTILITY + ubus_addr, SAR_REG_CMD);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 239) waitfor_idle(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 240) spin_unlock_irqrestore(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 241) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 242)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 243) #ifdef HAVE_EEPROM
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 244) static u32 rdsrtab[] =
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 245) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 246) SAR_GP_EECS | SAR_GP_EESCLK,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 247) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 248) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 249) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 250) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 251) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 252) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 253) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 254) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 255) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 256) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 257) SAR_GP_EEDO,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 258) SAR_GP_EESCLK | SAR_GP_EEDO, /* 1 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 259) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 260) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 261) SAR_GP_EEDO,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 262) SAR_GP_EESCLK | SAR_GP_EEDO /* 1 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 263) };
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 264)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 265) static u32 wrentab[] =
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 266) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 267) SAR_GP_EECS | SAR_GP_EESCLK,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 268) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 269) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 270) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 271) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 272) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 273) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 274) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 275) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 276) SAR_GP_EEDO,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 277) SAR_GP_EESCLK | SAR_GP_EEDO, /* 1 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 278) SAR_GP_EEDO,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 279) SAR_GP_EESCLK | SAR_GP_EEDO, /* 1 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 280) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 281) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 282) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 283) SAR_GP_EESCLK /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 284) };
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 285)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 286) static u32 rdtab[] =
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 287) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 288) SAR_GP_EECS | SAR_GP_EESCLK,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 289) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 290) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 291) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 292) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 293) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 294) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 295) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 296) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 297) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 298) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 299) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 300) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 301) SAR_GP_EEDO,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 302) SAR_GP_EESCLK | SAR_GP_EEDO, /* 1 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 303) SAR_GP_EEDO,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 304) SAR_GP_EESCLK | SAR_GP_EEDO /* 1 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 305) };
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 306)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 307) static u32 wrtab[] =
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 308) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 309) SAR_GP_EECS | SAR_GP_EESCLK,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 310) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 311) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 312) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 313) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 314) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 315) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 316) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 317) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 318) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 319) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 320) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 321) SAR_GP_EESCLK, /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 322) SAR_GP_EEDO,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 323) SAR_GP_EESCLK | SAR_GP_EEDO, /* 1 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 324) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 325) SAR_GP_EESCLK /* 0 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 326) };
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 327)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 328) static u32 clktab[] =
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 329) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 330) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 331) SAR_GP_EESCLK,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 332) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 333) SAR_GP_EESCLK,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 334) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 335) SAR_GP_EESCLK,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 336) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 337) SAR_GP_EESCLK,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 338) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 339) SAR_GP_EESCLK,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 340) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 341) SAR_GP_EESCLK,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 342) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 343) SAR_GP_EESCLK,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 344) 0,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 345) SAR_GP_EESCLK,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 346) 0
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 347) };
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 348)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 349) static u32
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 350) idt77252_read_gp(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 351) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 352) u32 gp;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 353)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 354) gp = readl(SAR_REG_GP);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 355) #if 0
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 356) printk("RD: %s\n", gp & SAR_GP_EEDI ? "1" : "0");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 357) #endif
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 358) return gp;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 359) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 360)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 361) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 362) idt77252_write_gp(struct idt77252_dev *card, u32 value)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 363) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 364) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 365)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 366) #if 0
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 367) printk("WR: %s %s %s\n", value & SAR_GP_EECS ? " " : "/CS",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 368) value & SAR_GP_EESCLK ? "HIGH" : "LOW ",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 369) value & SAR_GP_EEDO ? "1" : "0");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 370) #endif
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 371)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 372) spin_lock_irqsave(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 373) waitfor_idle(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 374) writel(value, SAR_REG_GP);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 375) spin_unlock_irqrestore(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 376) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 377)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 378) static u8
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 379) idt77252_eeprom_read_status(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 380) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 381) u8 byte;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 382) u32 gp;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 383) int i, j;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 384)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 385) gp = idt77252_read_gp(card) & ~(SAR_GP_EESCLK|SAR_GP_EECS|SAR_GP_EEDO);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 386)
36fe55d6a3c70 (Ahmed S. Darwish 2007-02-16 01:42:23 -0800 387) for (i = 0; i < ARRAY_SIZE(rdsrtab); i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 388) idt77252_write_gp(card, gp | rdsrtab[i]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 389) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 390) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 391) idt77252_write_gp(card, gp | SAR_GP_EECS);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 392) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 393)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 394) byte = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 395) for (i = 0, j = 0; i < 8; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 396) byte <<= 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 397)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 398) idt77252_write_gp(card, gp | clktab[j++]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 399) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 400)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 401) byte |= idt77252_read_gp(card) & SAR_GP_EEDI ? 1 : 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 402)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 403) idt77252_write_gp(card, gp | clktab[j++]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 404) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 405) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 406) idt77252_write_gp(card, gp | SAR_GP_EECS);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 407) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 408)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 409) return byte;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 410) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 411)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 412) static u8
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 413) idt77252_eeprom_read_byte(struct idt77252_dev *card, u8 offset)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 414) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 415) u8 byte;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 416) u32 gp;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 417) int i, j;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 418)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 419) gp = idt77252_read_gp(card) & ~(SAR_GP_EESCLK|SAR_GP_EECS|SAR_GP_EEDO);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 420)
36fe55d6a3c70 (Ahmed S. Darwish 2007-02-16 01:42:23 -0800 421) for (i = 0; i < ARRAY_SIZE(rdtab); i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 422) idt77252_write_gp(card, gp | rdtab[i]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 423) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 424) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 425) idt77252_write_gp(card, gp | SAR_GP_EECS);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 426) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 427)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 428) for (i = 0, j = 0; i < 8; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 429) idt77252_write_gp(card, gp | clktab[j++] |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 430) (offset & 1 ? SAR_GP_EEDO : 0));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 431) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 432)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 433) idt77252_write_gp(card, gp | clktab[j++] |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 434) (offset & 1 ? SAR_GP_EEDO : 0));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 435) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 436)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 437) offset >>= 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 438) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 439) idt77252_write_gp(card, gp | SAR_GP_EECS);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 440) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 441)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 442) byte = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 443) for (i = 0, j = 0; i < 8; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 444) byte <<= 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 445)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 446) idt77252_write_gp(card, gp | clktab[j++]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 447) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 448)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 449) byte |= idt77252_read_gp(card) & SAR_GP_EEDI ? 1 : 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 450)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 451) idt77252_write_gp(card, gp | clktab[j++]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 452) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 453) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 454) idt77252_write_gp(card, gp | SAR_GP_EECS);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 455) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 456)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 457) return byte;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 458) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 459)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 460) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 461) idt77252_eeprom_write_byte(struct idt77252_dev *card, u8 offset, u8 data)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 462) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 463) u32 gp;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 464) int i, j;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 465)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 466) gp = idt77252_read_gp(card) & ~(SAR_GP_EESCLK|SAR_GP_EECS|SAR_GP_EEDO);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 467)
36fe55d6a3c70 (Ahmed S. Darwish 2007-02-16 01:42:23 -0800 468) for (i = 0; i < ARRAY_SIZE(wrentab); i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 469) idt77252_write_gp(card, gp | wrentab[i]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 470) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 471) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 472) idt77252_write_gp(card, gp | SAR_GP_EECS);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 473) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 474)
36fe55d6a3c70 (Ahmed S. Darwish 2007-02-16 01:42:23 -0800 475) for (i = 0; i < ARRAY_SIZE(wrtab); i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 476) idt77252_write_gp(card, gp | wrtab[i]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 477) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 478) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 479) idt77252_write_gp(card, gp | SAR_GP_EECS);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 480) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 481)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 482) for (i = 0, j = 0; i < 8; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 483) idt77252_write_gp(card, gp | clktab[j++] |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 484) (offset & 1 ? SAR_GP_EEDO : 0));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 485) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 486)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 487) idt77252_write_gp(card, gp | clktab[j++] |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 488) (offset & 1 ? SAR_GP_EEDO : 0));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 489) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 490)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 491) offset >>= 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 492) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 493) idt77252_write_gp(card, gp | SAR_GP_EECS);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 494) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 495)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 496) for (i = 0, j = 0; i < 8; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 497) idt77252_write_gp(card, gp | clktab[j++] |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 498) (data & 1 ? SAR_GP_EEDO : 0));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 499) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 500)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 501) idt77252_write_gp(card, gp | clktab[j++] |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 502) (data & 1 ? SAR_GP_EEDO : 0));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 503) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 504)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 505) data >>= 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 506) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 507) idt77252_write_gp(card, gp | SAR_GP_EECS);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 508) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 509) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 510)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 511) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 512) idt77252_eeprom_init(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 513) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 514) u32 gp;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 515)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 516) gp = idt77252_read_gp(card) & ~(SAR_GP_EESCLK|SAR_GP_EECS|SAR_GP_EEDO);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 517)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 518) idt77252_write_gp(card, gp | SAR_GP_EECS | SAR_GP_EESCLK);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 519) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 520) idt77252_write_gp(card, gp | SAR_GP_EECS);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 521) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 522) idt77252_write_gp(card, gp | SAR_GP_EECS | SAR_GP_EESCLK);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 523) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 524) idt77252_write_gp(card, gp | SAR_GP_EECS);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 525) udelay(5);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 526) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 527) #endif /* HAVE_EEPROM */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 528)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 529)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 530) #ifdef CONFIG_ATM_IDT77252_DEBUG
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 531) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 532) dump_tct(struct idt77252_dev *card, int index)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 533) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 534) unsigned long tct;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 535) int i;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 536)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 537) tct = (unsigned long) (card->tct_base + index * SAR_SRAM_TCT_SIZE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 538)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 539) printk("%s: TCT %x:", card->name, index);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 540) for (i = 0; i < 8; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 541) printk(" %08x", read_sram(card, tct + i));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 542) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 543) printk("\n");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 544) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 545)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 546) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 547) idt77252_tx_dump(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 548) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 549) struct atm_vcc *vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 550) struct vc_map *vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 551) int i;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 552)
5a346a10c0b11 (Harvey Harrison 2008-03-05 18:38:07 -0800 553) printk("%s\n", __func__);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 554) for (i = 0; i < card->tct_size; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 555) vc = card->vcs[i];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 556) if (!vc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 557) continue;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 558)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 559) vcc = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 560) if (vc->rx_vcc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 561) vcc = vc->rx_vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 562) else if (vc->tx_vcc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 563) vcc = vc->tx_vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 564)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 565) if (!vcc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 566) continue;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 567)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 568) printk("%s: Connection %d:\n", card->name, vc->index);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 569) dump_tct(card, vc->index);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 570) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 571) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 572) #endif
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 573)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 574)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 575) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 576) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 577) /* SCQ Handling */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 578) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 579) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 580)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 581) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 582) sb_pool_add(struct idt77252_dev *card, struct sk_buff *skb, int queue)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 583) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 584) struct sb_pool *pool = &card->sbpool[queue];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 585) int index;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 586)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 587) index = pool->index;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 588) while (pool->skb[index]) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 589) index = (index + 1) & FBQ_MASK;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 590) if (index == pool->index)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 591) return -ENOBUFS;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 592) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 593)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 594) pool->skb[index] = skb;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 595) IDT77252_PRV_POOL(skb) = POOL_HANDLE(queue, index);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 596)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 597) pool->index = (index + 1) & FBQ_MASK;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 598) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 599) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 600)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 601) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 602) sb_pool_remove(struct idt77252_dev *card, struct sk_buff *skb)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 603) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 604) unsigned int queue, index;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 605) u32 handle;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 606)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 607) handle = IDT77252_PRV_POOL(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 608)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 609) queue = POOL_QUEUE(handle);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 610) if (queue > 3)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 611) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 612)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 613) index = POOL_INDEX(handle);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 614) if (index > FBQ_SIZE - 1)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 615) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 616)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 617) card->sbpool[queue].skb[index] = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 618) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 619)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 620) static struct sk_buff *
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 621) sb_pool_skb(struct idt77252_dev *card, u32 handle)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 622) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 623) unsigned int queue, index;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 624)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 625) queue = POOL_QUEUE(handle);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 626) if (queue > 3)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 627) return NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 628)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 629) index = POOL_INDEX(handle);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 630) if (index > FBQ_SIZE - 1)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 631) return NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 632)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 633) return card->sbpool[queue].skb[index];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 634) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 635)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 636) static struct scq_info *
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 637) alloc_scq(struct idt77252_dev *card, int class)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 638) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 639) struct scq_info *scq;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 640)
0c1cca1d8e0d5 (Om Narasimhan 2006-10-03 16:27:18 -0700 641) scq = kzalloc(sizeof(struct scq_info), GFP_KERNEL);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 642) if (!scq)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 643) return NULL;
750afb08ca713 (Luis Chamberlain 2019-01-04 09:23:09 +0100 644) scq->base = dma_alloc_coherent(&card->pcidev->dev, SCQ_SIZE,
750afb08ca713 (Luis Chamberlain 2019-01-04 09:23:09 +0100 645) &scq->paddr, GFP_KERNEL);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 646) if (scq->base == NULL) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 647) kfree(scq);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 648) return NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 649) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 650)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 651) scq->next = scq->base;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 652) scq->last = scq->base + (SCQ_ENTRIES - 1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 653) atomic_set(&scq->used, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 654)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 655) spin_lock_init(&scq->lock);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 656) spin_lock_init(&scq->skblock);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 657)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 658) skb_queue_head_init(&scq->transmit);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 659) skb_queue_head_init(&scq->pending);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 660)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 661) TXPRINTK("idt77252: SCQ: base 0x%p, next 0x%p, last 0x%p, paddr %08llx\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 662) scq->base, scq->next, scq->last, (unsigned long long)scq->paddr);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 663)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 664) return scq;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 665) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 666)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 667) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 668) free_scq(struct idt77252_dev *card, struct scq_info *scq)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 669) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 670) struct sk_buff *skb;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 671) struct atm_vcc *vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 672)
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 673) dma_free_coherent(&card->pcidev->dev, SCQ_SIZE,
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 674) scq->base, scq->paddr);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 675)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 676) while ((skb = skb_dequeue(&scq->transmit))) {
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 677) dma_unmap_single(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 678) skb->len, DMA_TO_DEVICE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 679)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 680) vcc = ATM_SKB(skb)->vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 681) if (vcc->pop)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 682) vcc->pop(vcc, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 683) else
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 684) dev_kfree_skb(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 685) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 686)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 687) while ((skb = skb_dequeue(&scq->pending))) {
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 688) dma_unmap_single(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 689) skb->len, DMA_TO_DEVICE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 690)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 691) vcc = ATM_SKB(skb)->vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 692) if (vcc->pop)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 693) vcc->pop(vcc, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 694) else
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 695) dev_kfree_skb(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 696) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 697)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 698) kfree(scq);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 699) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 700)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 701)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 702) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 703) push_on_scq(struct idt77252_dev *card, struct vc_map *vc, struct sk_buff *skb)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 704) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 705) struct scq_info *scq = vc->scq;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 706) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 707) struct scqe *tbd;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 708) int entries;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 709)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 710) TXPRINTK("%s: SCQ: next 0x%p\n", card->name, scq->next);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 711)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 712) atomic_inc(&scq->used);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 713) entries = atomic_read(&scq->used);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 714) if (entries > (SCQ_ENTRIES - 1)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 715) atomic_dec(&scq->used);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 716) goto out;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 717) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 718)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 719) skb_queue_tail(&scq->transmit, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 720)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 721) spin_lock_irqsave(&vc->lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 722) if (vc->estimator) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 723) struct atm_vcc *vcc = vc->tx_vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 724) struct sock *sk = sk_atm(vcc);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 725)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 726) vc->estimator->cells += (skb->len + 47) / 48;
14afee4b6092f (Reshetova, Elena 2017-06-30 13:08:00 +0300 727) if (refcount_read(&sk->sk_wmem_alloc) >
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 728) (sk->sk_sndbuf >> 1)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 729) u32 cps = vc->estimator->maxcps;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 730)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 731) vc->estimator->cps = cps;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 732) vc->estimator->avcps = cps << 5;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 733) if (vc->lacr < vc->init_er) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 734) vc->lacr = vc->init_er;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 735) writel(TCMDQ_LACR | (vc->lacr << 16) |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 736) vc->index, SAR_REG_TCMDQ);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 737) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 738) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 739) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 740) spin_unlock_irqrestore(&vc->lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 741)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 742) tbd = &IDT77252_PRV_TBD(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 743)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 744) spin_lock_irqsave(&scq->lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 745) scq->next->word_1 = cpu_to_le32(tbd->word_1 |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 746) SAR_TBD_TSIF | SAR_TBD_GTSI);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 747) scq->next->word_2 = cpu_to_le32(tbd->word_2);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 748) scq->next->word_3 = cpu_to_le32(tbd->word_3);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 749) scq->next->word_4 = cpu_to_le32(tbd->word_4);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 750)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 751) if (scq->next == scq->last)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 752) scq->next = scq->base;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 753) else
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 754) scq->next++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 755)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 756) write_sram(card, scq->scd,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 757) scq->paddr +
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 758) (u32)((unsigned long)scq->next - (unsigned long)scq->base));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 759) spin_unlock_irqrestore(&scq->lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 760)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 761) scq->trans_start = jiffies;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 762)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 763) if (test_and_clear_bit(VCF_IDLE, &vc->flags)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 764) writel(TCMDQ_START_LACR | (vc->lacr << 16) | vc->index,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 765) SAR_REG_TCMDQ);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 766) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 767)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 768) TXPRINTK("%d entries in SCQ used (push).\n", atomic_read(&scq->used));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 769)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 770) XPRINTK("%s: SCQ (after push %2d) head = 0x%x, next = 0x%p.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 771) card->name, atomic_read(&scq->used),
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 772) read_sram(card, scq->scd + 1), scq->next);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 773)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 774) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 775)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 776) out:
e1bd232b641a0 (Marcelo Feitoza Parisi 2005-07-19 13:55:14 -0700 777) if (time_after(jiffies, scq->trans_start + HZ)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 778) printk("%s: Error pushing TBD for %d.%d\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 779) card->name, vc->tx_vcc->vpi, vc->tx_vcc->vci);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 780) #ifdef CONFIG_ATM_IDT77252_DEBUG
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 781) idt77252_tx_dump(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 782) #endif
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 783) scq->trans_start = jiffies;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 784) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 785)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 786) return -ENOBUFS;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 787) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 788)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 789)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 790) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 791) drain_scq(struct idt77252_dev *card, struct vc_map *vc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 792) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 793) struct scq_info *scq = vc->scq;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 794) struct sk_buff *skb;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 795) struct atm_vcc *vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 796)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 797) TXPRINTK("%s: SCQ (before drain %2d) next = 0x%p.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 798) card->name, atomic_read(&scq->used), scq->next);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 799)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 800) skb = skb_dequeue(&scq->transmit);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 801) if (skb) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 802) TXPRINTK("%s: freeing skb at %p.\n", card->name, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 803)
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 804) dma_unmap_single(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 805) skb->len, DMA_TO_DEVICE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 806)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 807) vcc = ATM_SKB(skb)->vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 808)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 809) if (vcc->pop)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 810) vcc->pop(vcc, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 811) else
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 812) dev_kfree_skb(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 813)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 814) atomic_inc(&vcc->stats->tx);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 815) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 816)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 817) atomic_dec(&scq->used);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 818)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 819) spin_lock(&scq->skblock);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 820) while ((skb = skb_dequeue(&scq->pending))) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 821) if (push_on_scq(card, vc, skb)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 822) skb_queue_head(&vc->scq->pending, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 823) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 824) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 825) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 826) spin_unlock(&scq->skblock);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 827) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 828)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 829) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 830) queue_skb(struct idt77252_dev *card, struct vc_map *vc,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 831) struct sk_buff *skb, int oam)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 832) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 833) struct atm_vcc *vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 834) struct scqe *tbd;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 835) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 836) int error;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 837) int aal;
cbbb64f62acd9 (Jia-Ju Bai 2020-08-02 17:33:40 +0800 838) u32 word4;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 839)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 840) if (skb->len == 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 841) printk("%s: invalid skb->len (%d)\n", card->name, skb->len);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 842) return -EINVAL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 843) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 844)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 845) TXPRINTK("%s: Sending %d bytes of data.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 846) card->name, skb->len);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 847)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 848) tbd = &IDT77252_PRV_TBD(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 849) vcc = ATM_SKB(skb)->vcc;
cbbb64f62acd9 (Jia-Ju Bai 2020-08-02 17:33:40 +0800 850) word4 = (skb->data[0] << 24) | (skb->data[1] << 16) |
cbbb64f62acd9 (Jia-Ju Bai 2020-08-02 17:33:40 +0800 851) (skb->data[2] << 8) | (skb->data[3] << 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 852)
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 853) IDT77252_PRV_PADDR(skb) = dma_map_single(&card->pcidev->dev, skb->data,
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 854) skb->len, DMA_TO_DEVICE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 855)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 856) error = -EINVAL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 857)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 858) if (oam) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 859) if (skb->len != 52)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 860) goto errout;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 861)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 862) tbd->word_1 = SAR_TBD_OAM | ATM_CELL_PAYLOAD | SAR_TBD_EPDU;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 863) tbd->word_2 = IDT77252_PRV_PADDR(skb) + 4;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 864) tbd->word_3 = 0x00000000;
cbbb64f62acd9 (Jia-Ju Bai 2020-08-02 17:33:40 +0800 865) tbd->word_4 = word4;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 866)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 867) if (test_bit(VCF_RSV, &vc->flags))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 868) vc = card->vcs[0];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 869)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 870) goto done;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 871) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 872)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 873) if (test_bit(VCF_RSV, &vc->flags)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 874) printk("%s: Trying to transmit on reserved VC\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 875) goto errout;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 876) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 877)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 878) aal = vcc->qos.aal;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 879)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 880) switch (aal) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 881) case ATM_AAL0:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 882) case ATM_AAL34:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 883) if (skb->len > 52)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 884) goto errout;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 885)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 886) if (aal == ATM_AAL0)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 887) tbd->word_1 = SAR_TBD_EPDU | SAR_TBD_AAL0 |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 888) ATM_CELL_PAYLOAD;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 889) else
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 890) tbd->word_1 = SAR_TBD_EPDU | SAR_TBD_AAL34 |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 891) ATM_CELL_PAYLOAD;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 892)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 893) tbd->word_2 = IDT77252_PRV_PADDR(skb) + 4;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 894) tbd->word_3 = 0x00000000;
cbbb64f62acd9 (Jia-Ju Bai 2020-08-02 17:33:40 +0800 895) tbd->word_4 = word4;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 896) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 897)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 898) case ATM_AAL5:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 899) tbd->word_1 = SAR_TBD_EPDU | SAR_TBD_AAL5 | skb->len;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 900) tbd->word_2 = IDT77252_PRV_PADDR(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 901) tbd->word_3 = skb->len;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 902) tbd->word_4 = (vcc->vpi << SAR_TBD_VPI_SHIFT) |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 903) (vcc->vci << SAR_TBD_VCI_SHIFT);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 904) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 905)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 906) case ATM_AAL1:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 907) case ATM_AAL2:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 908) default:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 909) printk("%s: Traffic type not supported.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 910) error = -EPROTONOSUPPORT;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 911) goto errout;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 912) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 913)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 914) done:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 915) spin_lock_irqsave(&vc->scq->skblock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 916) skb_queue_tail(&vc->scq->pending, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 917)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 918) while ((skb = skb_dequeue(&vc->scq->pending))) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 919) if (push_on_scq(card, vc, skb)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 920) skb_queue_head(&vc->scq->pending, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 921) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 922) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 923) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 924) spin_unlock_irqrestore(&vc->scq->skblock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 925)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 926) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 927)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 928) errout:
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 929) dma_unmap_single(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 930) skb->len, DMA_TO_DEVICE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 931) return error;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 932) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 933)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 934) static unsigned long
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 935) get_free_scd(struct idt77252_dev *card, struct vc_map *vc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 936) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 937) int i;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 938)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 939) for (i = 0; i < card->scd_size; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 940) if (!card->scd2vc[i]) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 941) card->scd2vc[i] = vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 942) vc->scd_index = i;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 943) return card->scd_base + i * SAR_SRAM_SCD_SIZE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 944) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 945) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 946) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 947) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 948)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 949) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 950) fill_scd(struct idt77252_dev *card, struct scq_info *scq, int class)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 951) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 952) write_sram(card, scq->scd, scq->paddr);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 953) write_sram(card, scq->scd + 1, 0x00000000);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 954) write_sram(card, scq->scd + 2, 0xffffffff);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 955) write_sram(card, scq->scd + 3, 0x00000000);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 956) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 957)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 958) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 959) clear_scd(struct idt77252_dev *card, struct scq_info *scq, int class)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 960) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 961) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 962) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 963)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 964) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 965) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 966) /* RSQ Handling */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 967) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 968) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 969)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 970) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 971) init_rsq(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 972) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 973) struct rsq_entry *rsqe;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 974)
750afb08ca713 (Luis Chamberlain 2019-01-04 09:23:09 +0100 975) card->rsq.base = dma_alloc_coherent(&card->pcidev->dev, RSQSIZE,
750afb08ca713 (Luis Chamberlain 2019-01-04 09:23:09 +0100 976) &card->rsq.paddr, GFP_KERNEL);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 977) if (card->rsq.base == NULL) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 978) printk("%s: can't allocate RSQ.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 979) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 980) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 981)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 982) card->rsq.last = card->rsq.base + RSQ_NUM_ENTRIES - 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 983) card->rsq.next = card->rsq.last;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 984) for (rsqe = card->rsq.base; rsqe <= card->rsq.last; rsqe++)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 985) rsqe->word_4 = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 986)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 987) writel((unsigned long) card->rsq.last - (unsigned long) card->rsq.base,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 988) SAR_REG_RSQH);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 989) writel(card->rsq.paddr, SAR_REG_RSQB);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 990)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 991) IPRINTK("%s: RSQ base at 0x%lx (0x%x).\n", card->name,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 992) (unsigned long) card->rsq.base,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 993) readl(SAR_REG_RSQB));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 994) IPRINTK("%s: RSQ head = 0x%x, base = 0x%x, tail = 0x%x.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 995) card->name,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 996) readl(SAR_REG_RSQH),
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 997) readl(SAR_REG_RSQB),
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 998) readl(SAR_REG_RSQT));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 999)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1000) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1001) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1002)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1003) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1004) deinit_rsq(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1005) {
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1006) dma_free_coherent(&card->pcidev->dev, RSQSIZE,
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1007) card->rsq.base, card->rsq.paddr);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1008) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1009)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1010) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1011) dequeue_rx(struct idt77252_dev *card, struct rsq_entry *rsqe)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1012) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1013) struct atm_vcc *vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1014) struct sk_buff *skb;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1015) struct rx_pool *rpp;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1016) struct vc_map *vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1017) u32 header, vpi, vci;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1018) u32 stat;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1019) int i;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1020)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1021) stat = le32_to_cpu(rsqe->word_4);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1022)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1023) if (stat & SAR_RSQE_IDLE) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1024) RXPRINTK("%s: message about inactive connection.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1025) card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1026) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1027) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1028)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1029) skb = sb_pool_skb(card, le32_to_cpu(rsqe->word_2));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1030) if (skb == NULL) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1031) printk("%s: NULL skb in %s, rsqe: %08x %08x %08x %08x\n",
5a346a10c0b11 (Harvey Harrison 2008-03-05 18:38:07 -0800 1032) card->name, __func__,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1033) le32_to_cpu(rsqe->word_1), le32_to_cpu(rsqe->word_2),
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1034) le32_to_cpu(rsqe->word_3), le32_to_cpu(rsqe->word_4));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1035) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1036) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1037)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1038) header = le32_to_cpu(rsqe->word_1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1039) vpi = (header >> 16) & 0x00ff;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1040) vci = (header >> 0) & 0xffff;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1041)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1042) RXPRINTK("%s: SDU for %d.%d received in buffer 0x%p (data 0x%p).\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1043) card->name, vpi, vci, skb, skb->data);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1044)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1045) if ((vpi >= (1 << card->vpibits)) || (vci != (vci & card->vcimask))) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1046) printk("%s: SDU received for out-of-range vc %u.%u\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1047) card->name, vpi, vci);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1048) recycle_rx_skb(card, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1049) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1050) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1051)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1052) vc = card->vcs[VPCI2VC(card, vpi, vci)];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1053) if (!vc || !test_bit(VCF_RX, &vc->flags)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1054) printk("%s: SDU received on non RX vc %u.%u\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1055) card->name, vpi, vci);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1056) recycle_rx_skb(card, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1057) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1058) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1059)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1060) vcc = vc->rx_vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1061)
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1062) dma_sync_single_for_cpu(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1063) skb_end_pointer(skb) - skb->data,
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1064) DMA_FROM_DEVICE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1065)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1066) if ((vcc->qos.aal == ATM_AAL0) ||
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1067) (vcc->qos.aal == ATM_AAL34)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1068) struct sk_buff *sb;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1069) unsigned char *cell;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1070) u32 aal0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1071)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1072) cell = skb->data;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1073) for (i = (stat & SAR_RSQE_CELLCNT); i; i--) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1074) if ((sb = dev_alloc_skb(64)) == NULL) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1075) printk("%s: Can't allocate buffers for aal0.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1076) card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1077) atomic_add(i, &vcc->stats->rx_drop);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1078) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1079) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1080) if (!atm_charge(vcc, sb->truesize)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1081) RXPRINTK("%s: atm_charge() dropped aal0 packets.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1082) card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1083) atomic_add(i - 1, &vcc->stats->rx_drop);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1084) dev_kfree_skb(sb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1085) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1086) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1087) aal0 = (vpi << ATM_HDR_VPI_SHIFT) |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1088) (vci << ATM_HDR_VCI_SHIFT);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1089) aal0 |= (stat & SAR_RSQE_EPDU) ? 0x00000002 : 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1090) aal0 |= (stat & SAR_RSQE_CLP) ? 0x00000001 : 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1091)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1092) *((u32 *) sb->data) = aal0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1093) skb_put(sb, sizeof(u32));
59ae1d127ac0a (Johannes Berg 2017-06-16 14:29:20 +0200 1094) skb_put_data(sb, cell, ATM_CELL_PAYLOAD);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1095)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1096) ATM_SKB(sb)->vcc = vcc;
a61bbcf28a8cb (Patrick McHardy 2005-08-14 17:24:31 -0700 1097) __net_timestamp(sb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1098) vcc->push(vcc, sb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1099) atomic_inc(&vcc->stats->rx);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1100)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1101) cell += ATM_CELL_PAYLOAD;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1102) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1103)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1104) recycle_rx_skb(card, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1105) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1106) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1107) if (vcc->qos.aal != ATM_AAL5) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1108) printk("%s: Unexpected AAL type in dequeue_rx(): %d.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1109) card->name, vcc->qos.aal);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1110) recycle_rx_skb(card, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1111) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1112) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1113) skb->len = (stat & SAR_RSQE_CELLCNT) * ATM_CELL_PAYLOAD;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1114)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1115) rpp = &vc->rcv.rx_pool;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1116)
ceade961c4c8d (David S. Miller 2008-09-21 21:38:26 -0700 1117) __skb_queue_tail(&rpp->queue, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1118) rpp->len += skb->len;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1119)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1120) if (stat & SAR_RSQE_EPDU) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1121) unsigned char *l1l2;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1122) unsigned int len;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1123)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1124) l1l2 = (unsigned char *) ((unsigned long) skb->data + skb->len - 6);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1125)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1126) len = (l1l2[0] << 8) | l1l2[1];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1127) len = len ? len : 0x10000;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1128)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1129) RXPRINTK("%s: PDU has %d bytes.\n", card->name, len);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1130)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1131) if ((len + 8 > rpp->len) || (len + (47 + 8) < rpp->len)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1132) RXPRINTK("%s: AAL5 PDU size mismatch: %d != %d. "
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1133) "(CDC: %08x)\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1134) card->name, len, rpp->len, readl(SAR_REG_CDC));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1135) recycle_rx_pool_skb(card, rpp);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1136) atomic_inc(&vcc->stats->rx_err);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1137) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1138) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1139) if (stat & SAR_RSQE_CRC) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1140) RXPRINTK("%s: AAL5 CRC error.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1141) recycle_rx_pool_skb(card, rpp);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1142) atomic_inc(&vcc->stats->rx_err);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1143) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1144) }
ceade961c4c8d (David S. Miller 2008-09-21 21:38:26 -0700 1145) if (skb_queue_len(&rpp->queue) > 1) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1146) struct sk_buff *sb;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1147)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1148) skb = dev_alloc_skb(rpp->len);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1149) if (!skb) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1150) RXPRINTK("%s: Can't alloc RX skb.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1151) card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1152) recycle_rx_pool_skb(card, rpp);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1153) atomic_inc(&vcc->stats->rx_err);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1154) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1155) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1156) if (!atm_charge(vcc, skb->truesize)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1157) recycle_rx_pool_skb(card, rpp);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1158) dev_kfree_skb(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1159) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1160) }
ceade961c4c8d (David S. Miller 2008-09-21 21:38:26 -0700 1161) skb_queue_walk(&rpp->queue, sb)
59ae1d127ac0a (Johannes Berg 2017-06-16 14:29:20 +0200 1162) skb_put_data(skb, sb->data, sb->len);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1163)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1164) recycle_rx_pool_skb(card, rpp);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1165)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1166) skb_trim(skb, len);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1167) ATM_SKB(skb)->vcc = vcc;
a61bbcf28a8cb (Patrick McHardy 2005-08-14 17:24:31 -0700 1168) __net_timestamp(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1169)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1170) vcc->push(vcc, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1171) atomic_inc(&vcc->stats->rx);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1172)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1173) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1174) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1175)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1176) flush_rx_pool(card, rpp);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1177)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1178) if (!atm_charge(vcc, skb->truesize)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1179) recycle_rx_skb(card, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1180) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1181) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1182)
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1183) dma_unmap_single(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
4305b541357dd (Arnaldo Carvalho de Melo 2007-04-19 20:43:29 -0700 1184) skb_end_pointer(skb) - skb->data,
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1185) DMA_FROM_DEVICE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1186) sb_pool_remove(card, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1187)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1188) skb_trim(skb, len);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1189) ATM_SKB(skb)->vcc = vcc;
a61bbcf28a8cb (Patrick McHardy 2005-08-14 17:24:31 -0700 1190) __net_timestamp(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1191)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1192) vcc->push(vcc, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1193) atomic_inc(&vcc->stats->rx);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1194)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1195) if (skb->truesize > SAR_FB_SIZE_3)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1196) add_rx_skb(card, 3, SAR_FB_SIZE_3, 1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1197) else if (skb->truesize > SAR_FB_SIZE_2)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1198) add_rx_skb(card, 2, SAR_FB_SIZE_2, 1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1199) else if (skb->truesize > SAR_FB_SIZE_1)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1200) add_rx_skb(card, 1, SAR_FB_SIZE_1, 1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1201) else
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1202) add_rx_skb(card, 0, SAR_FB_SIZE_0, 1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1203) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1204) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1205) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1206)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1207) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1208) idt77252_rx(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1209) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1210) struct rsq_entry *rsqe;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1211)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1212) if (card->rsq.next == card->rsq.last)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1213) rsqe = card->rsq.base;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1214) else
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1215) rsqe = card->rsq.next + 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1216)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1217) if (!(le32_to_cpu(rsqe->word_4) & SAR_RSQE_VALID)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1218) RXPRINTK("%s: no entry in RSQ.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1219) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1220) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1221)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1222) do {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1223) dequeue_rx(card, rsqe);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1224) rsqe->word_4 = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1225) card->rsq.next = rsqe;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1226) if (card->rsq.next == card->rsq.last)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1227) rsqe = card->rsq.base;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1228) else
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1229) rsqe = card->rsq.next + 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1230) } while (le32_to_cpu(rsqe->word_4) & SAR_RSQE_VALID);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1231)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1232) writel((unsigned long) card->rsq.next - (unsigned long) card->rsq.base,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1233) SAR_REG_RSQH);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1234) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1235)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1236) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1237) idt77252_rx_raw(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1238) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1239) struct sk_buff *queue;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1240) u32 head, tail;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1241) struct atm_vcc *vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1242) struct vc_map *vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1243) struct sk_buff *sb;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1244)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1245) if (card->raw_cell_head == NULL) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1246) u32 handle = le32_to_cpu(*(card->raw_cell_hnd + 1));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1247) card->raw_cell_head = sb_pool_skb(card, handle);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1248) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1249)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1250) queue = card->raw_cell_head;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1251) if (!queue)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1252) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1253)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1254) head = IDT77252_PRV_PADDR(queue) + (queue->data - queue->head - 16);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1255) tail = readl(SAR_REG_RAWCT);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1256)
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1257) dma_sync_single_for_cpu(&card->pcidev->dev, IDT77252_PRV_PADDR(queue),
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1258) skb_end_offset(queue) - 16,
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1259) DMA_FROM_DEVICE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1260)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1261) while (head != tail) {
edb4dcb717d71 (David S. Miller 2011-04-17 00:10:17 -0700 1262) unsigned int vpi, vci;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1263) u32 header;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1264)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1265) header = le32_to_cpu(*(u32 *) &queue->data[0]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1266)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1267) vpi = (header & ATM_HDR_VPI_MASK) >> ATM_HDR_VPI_SHIFT;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1268) vci = (header & ATM_HDR_VCI_MASK) >> ATM_HDR_VCI_SHIFT;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1269)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1270) #ifdef CONFIG_ATM_IDT77252_DEBUG
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1271) if (debug & DBG_RAW_CELL) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1272) int i;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1273)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1274) printk("%s: raw cell %x.%02x.%04x.%x.%x\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1275) card->name, (header >> 28) & 0x000f,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1276) (header >> 20) & 0x00ff,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1277) (header >> 4) & 0xffff,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1278) (header >> 1) & 0x0007,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1279) (header >> 0) & 0x0001);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1280) for (i = 16; i < 64; i++)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1281) printk(" %02x", queue->data[i]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1282) printk("\n");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1283) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1284) #endif
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1285)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1286) if (vpi >= (1<<card->vpibits) || vci >= (1<<card->vcibits)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1287) RPRINTK("%s: SDU received for out-of-range vc %u.%u\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1288) card->name, vpi, vci);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1289) goto drop;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1290) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1291)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1292) vc = card->vcs[VPCI2VC(card, vpi, vci)];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1293) if (!vc || !test_bit(VCF_RX, &vc->flags)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1294) RPRINTK("%s: SDU received on non RX vc %u.%u\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1295) card->name, vpi, vci);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1296) goto drop;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1297) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1298)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1299) vcc = vc->rx_vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1300)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1301) if (vcc->qos.aal != ATM_AAL0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1302) RPRINTK("%s: raw cell for non AAL0 vc %u.%u\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1303) card->name, vpi, vci);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1304) atomic_inc(&vcc->stats->rx_drop);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1305) goto drop;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1306) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1307)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1308) if ((sb = dev_alloc_skb(64)) == NULL) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1309) printk("%s: Can't allocate buffers for AAL0.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1310) card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1311) atomic_inc(&vcc->stats->rx_err);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1312) goto drop;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1313) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1314)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1315) if (!atm_charge(vcc, sb->truesize)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1316) RXPRINTK("%s: atm_charge() dropped AAL0 packets.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1317) card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1318) dev_kfree_skb(sb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1319) goto drop;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1320) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1321)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1322) *((u32 *) sb->data) = header;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1323) skb_put(sb, sizeof(u32));
59ae1d127ac0a (Johannes Berg 2017-06-16 14:29:20 +0200 1324) skb_put_data(sb, &(queue->data[16]), ATM_CELL_PAYLOAD);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1325)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1326) ATM_SKB(sb)->vcc = vcc;
a61bbcf28a8cb (Patrick McHardy 2005-08-14 17:24:31 -0700 1327) __net_timestamp(sb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1328) vcc->push(vcc, sb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1329) atomic_inc(&vcc->stats->rx);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1330)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1331) drop:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1332) skb_pull(queue, 64);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1333)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1334) head = IDT77252_PRV_PADDR(queue)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1335) + (queue->data - queue->head - 16);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1336)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1337) if (queue->len < 128) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1338) struct sk_buff *next;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1339) u32 handle;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1340)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1341) head = le32_to_cpu(*(u32 *) &queue->data[0]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1342) handle = le32_to_cpu(*(u32 *) &queue->data[4]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1343)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1344) next = sb_pool_skb(card, handle);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1345) recycle_rx_skb(card, queue);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1346)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1347) if (next) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1348) card->raw_cell_head = next;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1349) queue = card->raw_cell_head;
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1350) dma_sync_single_for_cpu(&card->pcidev->dev,
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1351) IDT77252_PRV_PADDR(queue),
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1352) (skb_end_pointer(queue) -
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1353) queue->data),
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1354) DMA_FROM_DEVICE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1355) } else {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1356) card->raw_cell_head = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1357) printk("%s: raw cell queue overrun\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1358) card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1359) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1360) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1361) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1362) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1363) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1364)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1365)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1366) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1367) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1368) /* TSQ Handling */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1369) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1370) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1371)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1372) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1373) init_tsq(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1374) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1375) struct tsq_entry *tsqe;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1376)
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1377) card->tsq.base = dma_alloc_coherent(&card->pcidev->dev, RSQSIZE,
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1378) &card->tsq.paddr, GFP_KERNEL);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1379) if (card->tsq.base == NULL) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1380) printk("%s: can't allocate TSQ.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1381) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1382) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1383)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1384) card->tsq.last = card->tsq.base + TSQ_NUM_ENTRIES - 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1385) card->tsq.next = card->tsq.last;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1386) for (tsqe = card->tsq.base; tsqe <= card->tsq.last; tsqe++)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1387) tsqe->word_2 = cpu_to_le32(SAR_TSQE_INVALID);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1388)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1389) writel(card->tsq.paddr, SAR_REG_TSQB);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1390) writel((unsigned long) card->tsq.next - (unsigned long) card->tsq.base,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1391) SAR_REG_TSQH);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1392)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1393) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1394) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1395)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1396) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1397) deinit_tsq(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1398) {
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1399) dma_free_coherent(&card->pcidev->dev, TSQSIZE,
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1400) card->tsq.base, card->tsq.paddr);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1401) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1402)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1403) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1404) idt77252_tx(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1405) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1406) struct tsq_entry *tsqe;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1407) unsigned int vpi, vci;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1408) struct vc_map *vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1409) u32 conn, stat;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1410)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1411) if (card->tsq.next == card->tsq.last)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1412) tsqe = card->tsq.base;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1413) else
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1414) tsqe = card->tsq.next + 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1415)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1416) TXPRINTK("idt77252_tx: tsq %p: base %p, next %p, last %p\n", tsqe,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1417) card->tsq.base, card->tsq.next, card->tsq.last);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1418) TXPRINTK("idt77252_tx: tsqb %08x, tsqt %08x, tsqh %08x, \n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1419) readl(SAR_REG_TSQB),
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1420) readl(SAR_REG_TSQT),
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1421) readl(SAR_REG_TSQH));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1422)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1423) stat = le32_to_cpu(tsqe->word_2);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1424)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1425) if (stat & SAR_TSQE_INVALID)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1426) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1427)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1428) do {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1429) TXPRINTK("tsqe: 0x%p [0x%08x 0x%08x]\n", tsqe,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1430) le32_to_cpu(tsqe->word_1),
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1431) le32_to_cpu(tsqe->word_2));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1432)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1433) switch (stat & SAR_TSQE_TYPE) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1434) case SAR_TSQE_TYPE_TIMER:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1435) TXPRINTK("%s: Timer RollOver detected.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1436) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1437)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1438) case SAR_TSQE_TYPE_IDLE:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1439)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1440) conn = le32_to_cpu(tsqe->word_1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1441)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1442) if (SAR_TSQE_TAG(stat) == 0x10) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1443) #ifdef NOTDEF
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1444) printk("%s: Connection %d halted.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1445) card->name,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1446) le32_to_cpu(tsqe->word_1) & 0x1fff);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1447) #endif
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1448) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1449) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1450)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1451) vc = card->vcs[conn & 0x1fff];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1452) if (!vc) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1453) printk("%s: could not find VC from conn %d\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1454) card->name, conn & 0x1fff);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1455) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1456) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1457)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1458) printk("%s: Connection %d IDLE.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1459) card->name, vc->index);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1460)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1461) set_bit(VCF_IDLE, &vc->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1462) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1463)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1464) case SAR_TSQE_TYPE_TSR:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1465)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1466) conn = le32_to_cpu(tsqe->word_1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1467)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1468) vc = card->vcs[conn & 0x1fff];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1469) if (!vc) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1470) printk("%s: no VC at index %d\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1471) card->name,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1472) le32_to_cpu(tsqe->word_1) & 0x1fff);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1473) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1474) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1475)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1476) drain_scq(card, vc);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1477) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1478)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1479) case SAR_TSQE_TYPE_TBD_COMP:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1480)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1481) conn = le32_to_cpu(tsqe->word_1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1482)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1483) vpi = (conn >> SAR_TBD_VPI_SHIFT) & 0x00ff;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1484) vci = (conn >> SAR_TBD_VCI_SHIFT) & 0xffff;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1485)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1486) if (vpi >= (1 << card->vpibits) ||
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1487) vci >= (1 << card->vcibits)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1488) printk("%s: TBD complete: "
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1489) "out of range VPI.VCI %u.%u\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1490) card->name, vpi, vci);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1491) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1492) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1493)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1494) vc = card->vcs[VPCI2VC(card, vpi, vci)];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1495) if (!vc) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1496) printk("%s: TBD complete: "
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1497) "no VC at VPI.VCI %u.%u\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1498) card->name, vpi, vci);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1499) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1500) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1501)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1502) drain_scq(card, vc);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1503) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1504) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1505)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1506) tsqe->word_2 = cpu_to_le32(SAR_TSQE_INVALID);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1507)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1508) card->tsq.next = tsqe;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1509) if (card->tsq.next == card->tsq.last)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1510) tsqe = card->tsq.base;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1511) else
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1512) tsqe = card->tsq.next + 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1513)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1514) TXPRINTK("tsqe: %p: base %p, next %p, last %p\n", tsqe,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1515) card->tsq.base, card->tsq.next, card->tsq.last);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1516)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1517) stat = le32_to_cpu(tsqe->word_2);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1518)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1519) } while (!(stat & SAR_TSQE_INVALID));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1520)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1521) writel((unsigned long)card->tsq.next - (unsigned long)card->tsq.base,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1522) SAR_REG_TSQH);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1523)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1524) XPRINTK("idt77252_tx-after writel%d: TSQ head = 0x%x, tail = 0x%x, next = 0x%p.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1525) card->index, readl(SAR_REG_TSQH),
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1526) readl(SAR_REG_TSQT), card->tsq.next);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1527) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1528)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1529)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1530) static void
e99e88a9d2b06 (Kees Cook 2017-10-16 14:43:17 -0700 1531) tst_timer(struct timer_list *t)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1532) {
e99e88a9d2b06 (Kees Cook 2017-10-16 14:43:17 -0700 1533) struct idt77252_dev *card = from_timer(card, t, tst_timer);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1534) unsigned long base, idle, jump;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1535) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1536) u32 pc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1537) int e;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1538)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1539) spin_lock_irqsave(&card->tst_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1540)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1541) base = card->tst[card->tst_index];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1542) idle = card->tst[card->tst_index ^ 1];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1543)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1544) if (test_bit(TST_SWITCH_WAIT, &card->tst_state)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1545) jump = base + card->tst_size - 2;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1546)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1547) pc = readl(SAR_REG_NOW) >> 2;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1548) if ((pc ^ idle) & ~(card->tst_size - 1)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1549) mod_timer(&card->tst_timer, jiffies + 1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1550) goto out;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1551) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1552)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1553) clear_bit(TST_SWITCH_WAIT, &card->tst_state);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1554)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1555) card->tst_index ^= 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1556) write_sram(card, jump, TSTE_OPC_JMP | (base << 2));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1557)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1558) base = card->tst[card->tst_index];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1559) idle = card->tst[card->tst_index ^ 1];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1560)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1561) for (e = 0; e < card->tst_size - 2; e++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1562) if (card->soft_tst[e].tste & TSTE_PUSH_IDLE) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1563) write_sram(card, idle + e,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1564) card->soft_tst[e].tste & TSTE_MASK);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1565) card->soft_tst[e].tste &= ~(TSTE_PUSH_IDLE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1566) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1567) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1568) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1569)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1570) if (test_and_clear_bit(TST_SWITCH_PENDING, &card->tst_state)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1571)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1572) for (e = 0; e < card->tst_size - 2; e++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1573) if (card->soft_tst[e].tste & TSTE_PUSH_ACTIVE) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1574) write_sram(card, idle + e,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1575) card->soft_tst[e].tste & TSTE_MASK);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1576) card->soft_tst[e].tste &= ~(TSTE_PUSH_ACTIVE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1577) card->soft_tst[e].tste |= TSTE_PUSH_IDLE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1578) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1579) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1580)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1581) jump = base + card->tst_size - 2;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1582)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1583) write_sram(card, jump, TSTE_OPC_NULL);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1584) set_bit(TST_SWITCH_WAIT, &card->tst_state);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1585)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1586) mod_timer(&card->tst_timer, jiffies + 1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1587) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1588)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1589) out:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1590) spin_unlock_irqrestore(&card->tst_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1591) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1592)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1593) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1594) __fill_tst(struct idt77252_dev *card, struct vc_map *vc,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1595) int n, unsigned int opc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1596) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1597) unsigned long cl, avail;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1598) unsigned long idle;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1599) int e, r;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1600) u32 data;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1601)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1602) avail = card->tst_size - 2;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1603) for (e = 0; e < avail; e++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1604) if (card->soft_tst[e].vc == NULL)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1605) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1606) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1607) if (e >= avail) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1608) printk("%s: No free TST entries found\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1609) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1610) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1611)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1612) NPRINTK("%s: conn %d: first TST entry at %d.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1613) card->name, vc ? vc->index : -1, e);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1614)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1615) r = n;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1616) cl = avail;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1617) data = opc & TSTE_OPC_MASK;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1618) if (vc && (opc != TSTE_OPC_NULL))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1619) data = opc | vc->index;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1620)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1621) idle = card->tst[card->tst_index ^ 1];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1622)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1623) /*
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1624) * Fill Soft TST.
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1625) */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1626) while (r > 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1627) if ((cl >= avail) && (card->soft_tst[e].vc == NULL)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1628) if (vc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1629) card->soft_tst[e].vc = vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1630) else
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1631) card->soft_tst[e].vc = (void *)-1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1632)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1633) card->soft_tst[e].tste = data;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1634) if (timer_pending(&card->tst_timer))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1635) card->soft_tst[e].tste |= TSTE_PUSH_ACTIVE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1636) else {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1637) write_sram(card, idle + e, data);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1638) card->soft_tst[e].tste |= TSTE_PUSH_IDLE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1639) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1640)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1641) cl -= card->tst_size;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1642) r--;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1643) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1644)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1645) if (++e == avail)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1646) e = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1647) cl += n;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1648) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1649)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1650) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1651) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1652)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1653) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1654) fill_tst(struct idt77252_dev *card, struct vc_map *vc, int n, unsigned int opc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1655) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1656) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1657) int res;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1658)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1659) spin_lock_irqsave(&card->tst_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1660)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1661) res = __fill_tst(card, vc, n, opc);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1662)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1663) set_bit(TST_SWITCH_PENDING, &card->tst_state);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1664) if (!timer_pending(&card->tst_timer))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1665) mod_timer(&card->tst_timer, jiffies + 1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1666)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1667) spin_unlock_irqrestore(&card->tst_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1668) return res;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1669) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1670)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1671) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1672) __clear_tst(struct idt77252_dev *card, struct vc_map *vc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1673) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1674) unsigned long idle;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1675) int e;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1676)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1677) idle = card->tst[card->tst_index ^ 1];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1678)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1679) for (e = 0; e < card->tst_size - 2; e++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1680) if (card->soft_tst[e].vc == vc) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1681) card->soft_tst[e].vc = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1682)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1683) card->soft_tst[e].tste = TSTE_OPC_VAR;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1684) if (timer_pending(&card->tst_timer))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1685) card->soft_tst[e].tste |= TSTE_PUSH_ACTIVE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1686) else {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1687) write_sram(card, idle + e, TSTE_OPC_VAR);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1688) card->soft_tst[e].tste |= TSTE_PUSH_IDLE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1689) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1690) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1691) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1692)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1693) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1694) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1695)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1696) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1697) clear_tst(struct idt77252_dev *card, struct vc_map *vc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1698) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1699) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1700) int res;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1701)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1702) spin_lock_irqsave(&card->tst_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1703)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1704) res = __clear_tst(card, vc);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1705)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1706) set_bit(TST_SWITCH_PENDING, &card->tst_state);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1707) if (!timer_pending(&card->tst_timer))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1708) mod_timer(&card->tst_timer, jiffies + 1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1709)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1710) spin_unlock_irqrestore(&card->tst_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1711) return res;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1712) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1713)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1714) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1715) change_tst(struct idt77252_dev *card, struct vc_map *vc,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1716) int n, unsigned int opc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1717) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1718) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1719) int res;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1720)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1721) spin_lock_irqsave(&card->tst_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1722)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1723) __clear_tst(card, vc);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1724) res = __fill_tst(card, vc, n, opc);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1725)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1726) set_bit(TST_SWITCH_PENDING, &card->tst_state);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1727) if (!timer_pending(&card->tst_timer))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1728) mod_timer(&card->tst_timer, jiffies + 1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1729)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1730) spin_unlock_irqrestore(&card->tst_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1731) return res;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1732) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1733)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1734)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1735) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1736) set_tct(struct idt77252_dev *card, struct vc_map *vc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1737) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1738) unsigned long tct;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1739)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1740) tct = (unsigned long) (card->tct_base + vc->index * SAR_SRAM_TCT_SIZE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1741)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1742) switch (vc->class) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1743) case SCHED_CBR:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1744) OPRINTK("%s: writing TCT at 0x%lx, SCD 0x%lx.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1745) card->name, tct, vc->scq->scd);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1746)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1747) write_sram(card, tct + 0, TCT_CBR | vc->scq->scd);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1748) write_sram(card, tct + 1, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1749) write_sram(card, tct + 2, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1750) write_sram(card, tct + 3, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1751) write_sram(card, tct + 4, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1752) write_sram(card, tct + 5, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1753) write_sram(card, tct + 6, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1754) write_sram(card, tct + 7, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1755) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1756)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1757) case SCHED_UBR:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1758) OPRINTK("%s: writing TCT at 0x%lx, SCD 0x%lx.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1759) card->name, tct, vc->scq->scd);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1760)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1761) write_sram(card, tct + 0, TCT_UBR | vc->scq->scd);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1762) write_sram(card, tct + 1, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1763) write_sram(card, tct + 2, TCT_TSIF);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1764) write_sram(card, tct + 3, TCT_HALT | TCT_IDLE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1765) write_sram(card, tct + 4, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1766) write_sram(card, tct + 5, vc->init_er);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1767) write_sram(card, tct + 6, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1768) write_sram(card, tct + 7, TCT_FLAG_UBR);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1769) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1770)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1771) case SCHED_VBR:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1772) case SCHED_ABR:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1773) default:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1774) return -ENOSYS;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1775) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1776)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1777) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1778) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1779)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1780) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1781) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1782) /* FBQ Handling */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1783) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1784) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1785)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1786) static __inline__ int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1787) idt77252_fbq_full(struct idt77252_dev *card, int queue)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1788) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1789) return (readl(SAR_REG_STAT) >> (16 + (queue << 2))) == 0x0f;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1790) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1791)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1792) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1793) push_rx_skb(struct idt77252_dev *card, struct sk_buff *skb, int queue)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1794) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1795) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1796) u32 handle;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1797) u32 addr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1798)
27a884dc3cb63 (Arnaldo Carvalho de Melo 2007-04-19 20:29:13 -0700 1799) skb->data = skb->head;
27a884dc3cb63 (Arnaldo Carvalho de Melo 2007-04-19 20:29:13 -0700 1800) skb_reset_tail_pointer(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1801) skb->len = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1802)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1803) skb_reserve(skb, 16);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1804)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1805) switch (queue) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1806) case 0:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1807) skb_put(skb, SAR_FB_SIZE_0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1808) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1809) case 1:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1810) skb_put(skb, SAR_FB_SIZE_1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1811) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1812) case 2:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1813) skb_put(skb, SAR_FB_SIZE_2);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1814) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1815) case 3:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1816) skb_put(skb, SAR_FB_SIZE_3);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1817) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1818) default:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1819) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1820) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1821)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1822) if (idt77252_fbq_full(card, queue))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1823) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1824)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1825) memset(&skb->data[(skb->len & ~(0x3f)) - 64], 0, 2 * sizeof(u32));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1826)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1827) handle = IDT77252_PRV_POOL(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1828) addr = IDT77252_PRV_PADDR(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1829)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1830) spin_lock_irqsave(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1831) writel(handle, card->fbq[queue]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1832) writel(addr, card->fbq[queue]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1833) spin_unlock_irqrestore(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1834)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1835) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1836) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1837)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1838) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1839) add_rx_skb(struct idt77252_dev *card, int queue,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1840) unsigned int size, unsigned int count)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1841) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1842) struct sk_buff *skb;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1843) dma_addr_t paddr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1844) u32 handle;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1845)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1846) while (count--) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1847) skb = dev_alloc_skb(size);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1848) if (!skb)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1849) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1850)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1851) if (sb_pool_add(card, skb, queue)) {
5a346a10c0b11 (Harvey Harrison 2008-03-05 18:38:07 -0800 1852) printk("%s: SB POOL full\n", __func__);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1853) goto outfree;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1854) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1855)
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1856) paddr = dma_map_single(&card->pcidev->dev, skb->data,
4305b541357dd (Arnaldo Carvalho de Melo 2007-04-19 20:43:29 -0700 1857) skb_end_pointer(skb) - skb->data,
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1858) DMA_FROM_DEVICE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1859) IDT77252_PRV_PADDR(skb) = paddr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1860)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1861) if (push_rx_skb(card, skb, queue)) {
5a346a10c0b11 (Harvey Harrison 2008-03-05 18:38:07 -0800 1862) printk("%s: FB QUEUE full\n", __func__);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1863) goto outunmap;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1864) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1865) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1866)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1867) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1868)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1869) outunmap:
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1870) dma_unmap_single(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1871) skb_end_pointer(skb) - skb->data, DMA_FROM_DEVICE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1872)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1873) handle = IDT77252_PRV_POOL(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1874) card->sbpool[POOL_QUEUE(handle)].skb[POOL_INDEX(handle)] = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1875)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1876) outfree:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1877) dev_kfree_skb(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1878) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1879)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1880)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1881) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1882) recycle_rx_skb(struct idt77252_dev *card, struct sk_buff *skb)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1883) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1884) u32 handle = IDT77252_PRV_POOL(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1885) int err;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1886)
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1887) dma_sync_single_for_device(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1888) skb_end_pointer(skb) - skb->data,
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1889) DMA_FROM_DEVICE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1890)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1891) err = push_rx_skb(card, skb, POOL_QUEUE(handle));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1892) if (err) {
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1893) dma_unmap_single(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
4305b541357dd (Arnaldo Carvalho de Melo 2007-04-19 20:43:29 -0700 1894) skb_end_pointer(skb) - skb->data,
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 1895) DMA_FROM_DEVICE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1896) sb_pool_remove(card, skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1897) dev_kfree_skb(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1898) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1899) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1900)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1901) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1902) flush_rx_pool(struct idt77252_dev *card, struct rx_pool *rpp)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1903) {
ceade961c4c8d (David S. Miller 2008-09-21 21:38:26 -0700 1904) skb_queue_head_init(&rpp->queue);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1905) rpp->len = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1906) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1907)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1908) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1909) recycle_rx_pool_skb(struct idt77252_dev *card, struct rx_pool *rpp)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1910) {
ceade961c4c8d (David S. Miller 2008-09-21 21:38:26 -0700 1911) struct sk_buff *skb, *tmp;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1912)
ceade961c4c8d (David S. Miller 2008-09-21 21:38:26 -0700 1913) skb_queue_walk_safe(&rpp->queue, skb, tmp)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1914) recycle_rx_skb(card, skb);
ceade961c4c8d (David S. Miller 2008-09-21 21:38:26 -0700 1915)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1916) flush_rx_pool(card, rpp);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1917) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1918)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1919) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1920) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1921) /* ATM Interface */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1922) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1923) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1924)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1925) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1926) idt77252_phy_put(struct atm_dev *dev, unsigned char value, unsigned long addr)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1927) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1928) write_utility(dev->dev_data, 0x100 + (addr & 0x1ff), value);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1929) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1930)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1931) static unsigned char
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1932) idt77252_phy_get(struct atm_dev *dev, unsigned long addr)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1933) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1934) return read_utility(dev->dev_data, 0x100 + (addr & 0x1ff));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1935) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1936)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1937) static inline int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1938) idt77252_send_skb(struct atm_vcc *vcc, struct sk_buff *skb, int oam)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1939) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1940) struct atm_dev *dev = vcc->dev;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1941) struct idt77252_dev *card = dev->dev_data;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1942) struct vc_map *vc = vcc->dev_data;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1943) int err;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1944)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1945) if (vc == NULL) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1946) printk("%s: NULL connection in send().\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1947) atomic_inc(&vcc->stats->tx_err);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1948) dev_kfree_skb(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1949) return -EINVAL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1950) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1951) if (!test_bit(VCF_TX, &vc->flags)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1952) printk("%s: Trying to transmit on a non-tx VC.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1953) atomic_inc(&vcc->stats->tx_err);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1954) dev_kfree_skb(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1955) return -EINVAL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1956) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1957)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1958) switch (vcc->qos.aal) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1959) case ATM_AAL0:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1960) case ATM_AAL1:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1961) case ATM_AAL5:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1962) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1963) default:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1964) printk("%s: Unsupported AAL: %d\n", card->name, vcc->qos.aal);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1965) atomic_inc(&vcc->stats->tx_err);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1966) dev_kfree_skb(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1967) return -EINVAL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1968) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1969)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1970) if (skb_shinfo(skb)->nr_frags != 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1971) printk("%s: No scatter-gather yet.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1972) atomic_inc(&vcc->stats->tx_err);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1973) dev_kfree_skb(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1974) return -EINVAL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1975) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1976) ATM_SKB(skb)->vcc = vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1977)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1978) err = queue_skb(card, vc, skb, oam);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1979) if (err) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1980) atomic_inc(&vcc->stats->tx_err);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1981) dev_kfree_skb(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1982) return err;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1983) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1984)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1985) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1986) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1987)
f4c4b4a63153d (Adrian Bunk 2008-03-31 19:35:52 -0700 1988) static int idt77252_send(struct atm_vcc *vcc, struct sk_buff *skb)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1989) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1990) return idt77252_send_skb(vcc, skb, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1991) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1992)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1993) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1994) idt77252_send_oam(struct atm_vcc *vcc, void *cell, int flags)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1995) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1996) struct atm_dev *dev = vcc->dev;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1997) struct idt77252_dev *card = dev->dev_data;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1998) struct sk_buff *skb;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 1999)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2000) skb = dev_alloc_skb(64);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2001) if (!skb) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2002) printk("%s: Out of memory in send_oam().\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2003) atomic_inc(&vcc->stats->tx_err);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2004) return -ENOMEM;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2005) }
14afee4b6092f (Reshetova, Elena 2017-06-30 13:08:00 +0300 2006) refcount_add(skb->truesize, &sk_atm(vcc)->sk_wmem_alloc);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2007)
59ae1d127ac0a (Johannes Berg 2017-06-16 14:29:20 +0200 2008) skb_put_data(skb, cell, 52);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2009)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2010) return idt77252_send_skb(vcc, skb, 1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2011) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2012)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2013) static __inline__ unsigned int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2014) idt77252_fls(unsigned int x)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2015) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2016) int r = 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2017)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2018) if (x == 0)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2019) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2020) if (x & 0xffff0000) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2021) x >>= 16;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2022) r += 16;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2023) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2024) if (x & 0xff00) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2025) x >>= 8;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2026) r += 8;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2027) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2028) if (x & 0xf0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2029) x >>= 4;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2030) r += 4;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2031) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2032) if (x & 0xc) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2033) x >>= 2;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2034) r += 2;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2035) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2036) if (x & 0x2)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2037) r += 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2038) return r;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2039) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2040)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2041) static u16
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2042) idt77252_int_to_atmfp(unsigned int rate)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2043) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2044) u16 m, e;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2045)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2046) if (rate == 0)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2047) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2048) e = idt77252_fls(rate) - 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2049) if (e < 9)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2050) m = (rate - (1 << e)) << (9 - e);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2051) else if (e == 9)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2052) m = (rate - (1 << e));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2053) else /* e > 9 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2054) m = (rate - (1 << e)) >> (e - 9);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2055) return 0x4000 | (e << 9) | m;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2056) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2057)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2058) static u8
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2059) idt77252_rate_logindex(struct idt77252_dev *card, int pcr)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2060) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2061) u16 afp;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2062)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2063) afp = idt77252_int_to_atmfp(pcr < 0 ? -pcr : pcr);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2064) if (pcr < 0)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2065) return rate_to_log[(afp >> 5) & 0x1ff];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2066) return rate_to_log[((afp >> 5) + 1) & 0x1ff];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2067) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2068)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2069) static void
3d2ceaa63b81f (Kees Cook 2017-10-16 17:29:04 -0700 2070) idt77252_est_timer(struct timer_list *t)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2071) {
3d2ceaa63b81f (Kees Cook 2017-10-16 17:29:04 -0700 2072) struct rate_estimator *est = from_timer(est, t, timer);
3d2ceaa63b81f (Kees Cook 2017-10-16 17:29:04 -0700 2073) struct vc_map *vc = est->vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2074) struct idt77252_dev *card = vc->card;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2075) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2076) u32 rate, cps;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2077) u64 ncells;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2078) u8 lacr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2079)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2080) spin_lock_irqsave(&vc->lock, flags);
3d2ceaa63b81f (Kees Cook 2017-10-16 17:29:04 -0700 2081) if (!vc->estimator)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2082) goto out;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2083) ncells = est->cells;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2084)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2085) rate = ((u32)(ncells - est->last_cells)) << (7 - est->interval);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2086) est->last_cells = ncells;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2087) est->avcps += ((long)rate - (long)est->avcps) >> est->ewma_log;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2088) est->cps = (est->avcps + 0x1f) >> 5;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2089)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2090) cps = est->cps;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2091) if (cps < (est->maxcps >> 4))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2092) cps = est->maxcps >> 4;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2093)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2094) lacr = idt77252_rate_logindex(card, cps);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2095) if (lacr > vc->max_er)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2096) lacr = vc->max_er;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2097)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2098) if (lacr != vc->lacr) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2099) vc->lacr = lacr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2100) writel(TCMDQ_LACR|(vc->lacr << 16)|vc->index, SAR_REG_TCMDQ);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2101) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2102)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2103) est->timer.expires = jiffies + ((HZ / 4) << est->interval);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2104) add_timer(&est->timer);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2105)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2106) out:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2107) spin_unlock_irqrestore(&vc->lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2108) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2109)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2110) static struct rate_estimator *
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2111) idt77252_init_est(struct vc_map *vc, int pcr)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2112) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2113) struct rate_estimator *est;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2114)
0c1cca1d8e0d5 (Om Narasimhan 2006-10-03 16:27:18 -0700 2115) est = kzalloc(sizeof(struct rate_estimator), GFP_KERNEL);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2116) if (!est)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2117) return NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2118) est->maxcps = pcr < 0 ? -pcr : pcr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2119) est->cps = est->maxcps;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2120) est->avcps = est->cps << 5;
3d2ceaa63b81f (Kees Cook 2017-10-16 17:29:04 -0700 2121) est->vc = vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2122)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2123) est->interval = 2; /* XXX: make this configurable */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2124) est->ewma_log = 2; /* XXX: make this configurable */
3d2ceaa63b81f (Kees Cook 2017-10-16 17:29:04 -0700 2125) timer_setup(&est->timer, idt77252_est_timer, 0);
b973154a2278c (Jan Koniarik 2017-02-15 16:59:35 +0100 2126) mod_timer(&est->timer, jiffies + ((HZ / 4) << est->interval));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2127)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2128) return est;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2129) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2130)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2131) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2132) idt77252_init_cbr(struct idt77252_dev *card, struct vc_map *vc,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2133) struct atm_vcc *vcc, struct atm_qos *qos)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2134) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2135) int tst_free, tst_used, tst_entries;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2136) unsigned long tmpl, modl;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2137) int tcr, tcra;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2138)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2139) if ((qos->txtp.max_pcr == 0) &&
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2140) (qos->txtp.pcr == 0) && (qos->txtp.min_pcr == 0)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2141) printk("%s: trying to open a CBR VC with cell rate = 0\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2142) card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2143) return -EINVAL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2144) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2145)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2146) tst_used = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2147) tst_free = card->tst_free;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2148) if (test_bit(VCF_TX, &vc->flags))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2149) tst_used = vc->ntste;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2150) tst_free += tst_used;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2151)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2152) tcr = atm_pcr_goal(&qos->txtp);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2153) tcra = tcr >= 0 ? tcr : -tcr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2154)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2155) TXPRINTK("%s: CBR target cell rate = %d\n", card->name, tcra);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2156)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2157) tmpl = (unsigned long) tcra * ((unsigned long) card->tst_size - 2);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2158) modl = tmpl % (unsigned long)card->utopia_pcr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2159)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2160) tst_entries = (int) (tmpl / card->utopia_pcr);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2161) if (tcr > 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2162) if (modl > 0)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2163) tst_entries++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2164) } else if (tcr == 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2165) tst_entries = tst_free - SAR_TST_RESERVED;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2166) if (tst_entries <= 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2167) printk("%s: no CBR bandwidth free.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2168) return -ENOSR;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2169) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2170) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2171)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2172) if (tst_entries == 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2173) printk("%s: selected CBR bandwidth < granularity.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2174) card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2175) return -EINVAL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2176) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2177)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2178) if (tst_entries > (tst_free - SAR_TST_RESERVED)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2179) printk("%s: not enough CBR bandwidth free.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2180) return -ENOSR;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2181) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2182)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2183) vc->ntste = tst_entries;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2184)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2185) card->tst_free = tst_free - tst_entries;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2186) if (test_bit(VCF_TX, &vc->flags)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2187) if (tst_used == tst_entries)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2188) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2189)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2190) OPRINTK("%s: modify %d -> %d entries in TST.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2191) card->name, tst_used, tst_entries);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2192) change_tst(card, vc, tst_entries, TSTE_OPC_CBR);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2193) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2194) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2195)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2196) OPRINTK("%s: setting %d entries in TST.\n", card->name, tst_entries);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2197) fill_tst(card, vc, tst_entries, TSTE_OPC_CBR);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2198) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2199) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2200)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2201) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2202) idt77252_init_ubr(struct idt77252_dev *card, struct vc_map *vc,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2203) struct atm_vcc *vcc, struct atm_qos *qos)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2204) {
3d2ceaa63b81f (Kees Cook 2017-10-16 17:29:04 -0700 2205) struct rate_estimator *est = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2206) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2207) int tcr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2208)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2209) spin_lock_irqsave(&vc->lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2210) if (vc->estimator) {
3d2ceaa63b81f (Kees Cook 2017-10-16 17:29:04 -0700 2211) est = vc->estimator;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2212) vc->estimator = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2213) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2214) spin_unlock_irqrestore(&vc->lock, flags);
3d2ceaa63b81f (Kees Cook 2017-10-16 17:29:04 -0700 2215) if (est) {
3d2ceaa63b81f (Kees Cook 2017-10-16 17:29:04 -0700 2216) del_timer_sync(&est->timer);
3d2ceaa63b81f (Kees Cook 2017-10-16 17:29:04 -0700 2217) kfree(est);
3d2ceaa63b81f (Kees Cook 2017-10-16 17:29:04 -0700 2218) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2219)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2220) tcr = atm_pcr_goal(&qos->txtp);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2221) if (tcr == 0)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2222) tcr = card->link_pcr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2223)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2224) vc->estimator = idt77252_init_est(vc, tcr);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2225)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2226) vc->class = SCHED_UBR;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2227) vc->init_er = idt77252_rate_logindex(card, tcr);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2228) vc->lacr = vc->init_er;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2229) if (tcr < 0)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2230) vc->max_er = vc->init_er;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2231) else
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2232) vc->max_er = 0xff;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2233)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2234) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2235) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2236)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2237) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2238) idt77252_init_tx(struct idt77252_dev *card, struct vc_map *vc,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2239) struct atm_vcc *vcc, struct atm_qos *qos)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2240) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2241) int error;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2242)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2243) if (test_bit(VCF_TX, &vc->flags))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2244) return -EBUSY;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2245)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2246) switch (qos->txtp.traffic_class) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2247) case ATM_CBR:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2248) vc->class = SCHED_CBR;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2249) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2250)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2251) case ATM_UBR:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2252) vc->class = SCHED_UBR;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2253) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2254)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2255) case ATM_VBR:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2256) case ATM_ABR:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2257) default:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2258) return -EPROTONOSUPPORT;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2259) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2260)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2261) vc->scq = alloc_scq(card, vc->class);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2262) if (!vc->scq) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2263) printk("%s: can't get SCQ.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2264) return -ENOMEM;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2265) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2266)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2267) vc->scq->scd = get_free_scd(card, vc);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2268) if (vc->scq->scd == 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2269) printk("%s: no SCD available.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2270) free_scq(card, vc->scq);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2271) return -ENOMEM;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2272) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2273)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2274) fill_scd(card, vc->scq, vc->class);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2275)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2276) if (set_tct(card, vc)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2277) printk("%s: class %d not supported.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2278) card->name, qos->txtp.traffic_class);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2279)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2280) card->scd2vc[vc->scd_index] = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2281) free_scq(card, vc->scq);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2282) return -EPROTONOSUPPORT;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2283) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2284)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2285) switch (vc->class) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2286) case SCHED_CBR:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2287) error = idt77252_init_cbr(card, vc, vcc, qos);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2288) if (error) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2289) card->scd2vc[vc->scd_index] = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2290) free_scq(card, vc->scq);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2291) return error;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2292) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2293)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2294) clear_bit(VCF_IDLE, &vc->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2295) writel(TCMDQ_START | vc->index, SAR_REG_TCMDQ);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2296) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2297)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2298) case SCHED_UBR:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2299) error = idt77252_init_ubr(card, vc, vcc, qos);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2300) if (error) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2301) card->scd2vc[vc->scd_index] = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2302) free_scq(card, vc->scq);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2303) return error;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2304) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2305)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2306) set_bit(VCF_IDLE, &vc->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2307) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2308) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2309)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2310) vc->tx_vcc = vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2311) set_bit(VCF_TX, &vc->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2312) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2313) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2314)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2315) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2316) idt77252_init_rx(struct idt77252_dev *card, struct vc_map *vc,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2317) struct atm_vcc *vcc, struct atm_qos *qos)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2318) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2319) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2320) unsigned long addr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2321) u32 rcte = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2322)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2323) if (test_bit(VCF_RX, &vc->flags))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2324) return -EBUSY;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2325)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2326) vc->rx_vcc = vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2327) set_bit(VCF_RX, &vc->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2328)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2329) if ((vcc->vci == 3) || (vcc->vci == 4))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2330) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2331)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2332) flush_rx_pool(card, &vc->rcv.rx_pool);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2333)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2334) rcte |= SAR_RCTE_CONNECTOPEN;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2335) rcte |= SAR_RCTE_RAWCELLINTEN;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2336)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2337) switch (qos->aal) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2338) case ATM_AAL0:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2339) rcte |= SAR_RCTE_RCQ;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2340) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2341) case ATM_AAL1:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2342) rcte |= SAR_RCTE_OAM; /* Let SAR drop Video */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2343) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2344) case ATM_AAL34:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2345) rcte |= SAR_RCTE_AAL34;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2346) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2347) case ATM_AAL5:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2348) rcte |= SAR_RCTE_AAL5;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2349) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2350) default:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2351) rcte |= SAR_RCTE_RCQ;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2352) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2353) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2354)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2355) if (qos->aal != ATM_AAL5)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2356) rcte |= SAR_RCTE_FBP_1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2357) else if (qos->rxtp.max_sdu > SAR_FB_SIZE_2)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2358) rcte |= SAR_RCTE_FBP_3;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2359) else if (qos->rxtp.max_sdu > SAR_FB_SIZE_1)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2360) rcte |= SAR_RCTE_FBP_2;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2361) else if (qos->rxtp.max_sdu > SAR_FB_SIZE_0)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2362) rcte |= SAR_RCTE_FBP_1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2363) else
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2364) rcte |= SAR_RCTE_FBP_01;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2365)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2366) addr = card->rct_base + (vc->index << 2);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2367)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2368) OPRINTK("%s: writing RCT at 0x%lx\n", card->name, addr);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2369) write_sram(card, addr, rcte);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2370)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2371) spin_lock_irqsave(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2372) writel(SAR_CMD_OPEN_CONNECTION | (addr << 2), SAR_REG_CMD);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2373) waitfor_idle(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2374) spin_unlock_irqrestore(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2375)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2376) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2377) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2378)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2379) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2380) idt77252_open(struct atm_vcc *vcc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2381) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2382) struct atm_dev *dev = vcc->dev;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2383) struct idt77252_dev *card = dev->dev_data;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2384) struct vc_map *vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2385) unsigned int index;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2386) unsigned int inuse;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2387) int error;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2388) int vci = vcc->vci;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2389) short vpi = vcc->vpi;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2390)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2391) if (vpi == ATM_VPI_UNSPEC || vci == ATM_VCI_UNSPEC)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2392) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2393)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2394) if (vpi >= (1 << card->vpibits)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2395) printk("%s: unsupported VPI: %d\n", card->name, vpi);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2396) return -EINVAL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2397) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2398)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2399) if (vci >= (1 << card->vcibits)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2400) printk("%s: unsupported VCI: %d\n", card->name, vci);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2401) return -EINVAL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2402) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2403)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2404) set_bit(ATM_VF_ADDR, &vcc->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2405)
7e7a2d07b0faf (Matthias Kaehlcke 2007-05-23 14:45:45 -0700 2406) mutex_lock(&card->mutex);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2407)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2408) OPRINTK("%s: opening vpi.vci: %d.%d\n", card->name, vpi, vci);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2409)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2410) switch (vcc->qos.aal) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2411) case ATM_AAL0:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2412) case ATM_AAL1:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2413) case ATM_AAL5:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2414) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2415) default:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2416) printk("%s: Unsupported AAL: %d\n", card->name, vcc->qos.aal);
7e7a2d07b0faf (Matthias Kaehlcke 2007-05-23 14:45:45 -0700 2417) mutex_unlock(&card->mutex);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2418) return -EPROTONOSUPPORT;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2419) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2420)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2421) index = VPCI2VC(card, vpi, vci);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2422) if (!card->vcs[index]) {
0c1cca1d8e0d5 (Om Narasimhan 2006-10-03 16:27:18 -0700 2423) card->vcs[index] = kzalloc(sizeof(struct vc_map), GFP_KERNEL);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2424) if (!card->vcs[index]) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2425) printk("%s: can't alloc vc in open()\n", card->name);
7e7a2d07b0faf (Matthias Kaehlcke 2007-05-23 14:45:45 -0700 2426) mutex_unlock(&card->mutex);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2427) return -ENOMEM;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2428) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2429) card->vcs[index]->card = card;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2430) card->vcs[index]->index = index;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2431)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2432) spin_lock_init(&card->vcs[index]->lock);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2433) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2434) vc = card->vcs[index];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2435)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2436) vcc->dev_data = vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2437)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2438) IPRINTK("%s: idt77252_open: vc = %d (%d.%d) %s/%s (max RX SDU: %u)\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2439) card->name, vc->index, vcc->vpi, vcc->vci,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2440) vcc->qos.rxtp.traffic_class != ATM_NONE ? "rx" : "--",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2441) vcc->qos.txtp.traffic_class != ATM_NONE ? "tx" : "--",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2442) vcc->qos.rxtp.max_sdu);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2443)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2444) inuse = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2445) if (vcc->qos.txtp.traffic_class != ATM_NONE &&
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2446) test_bit(VCF_TX, &vc->flags))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2447) inuse = 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2448) if (vcc->qos.rxtp.traffic_class != ATM_NONE &&
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2449) test_bit(VCF_RX, &vc->flags))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2450) inuse += 2;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2451)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2452) if (inuse) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2453) printk("%s: %s vci already in use.\n", card->name,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2454) inuse == 1 ? "tx" : inuse == 2 ? "rx" : "tx and rx");
7e7a2d07b0faf (Matthias Kaehlcke 2007-05-23 14:45:45 -0700 2455) mutex_unlock(&card->mutex);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2456) return -EADDRINUSE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2457) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2458)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2459) if (vcc->qos.txtp.traffic_class != ATM_NONE) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2460) error = idt77252_init_tx(card, vc, vcc, &vcc->qos);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2461) if (error) {
7e7a2d07b0faf (Matthias Kaehlcke 2007-05-23 14:45:45 -0700 2462) mutex_unlock(&card->mutex);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2463) return error;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2464) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2465) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2466)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2467) if (vcc->qos.rxtp.traffic_class != ATM_NONE) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2468) error = idt77252_init_rx(card, vc, vcc, &vcc->qos);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2469) if (error) {
7e7a2d07b0faf (Matthias Kaehlcke 2007-05-23 14:45:45 -0700 2470) mutex_unlock(&card->mutex);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2471) return error;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2472) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2473) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2474)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2475) set_bit(ATM_VF_READY, &vcc->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2476)
7e7a2d07b0faf (Matthias Kaehlcke 2007-05-23 14:45:45 -0700 2477) mutex_unlock(&card->mutex);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2478) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2479) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2480)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2481) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2482) idt77252_close(struct atm_vcc *vcc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2483) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2484) struct atm_dev *dev = vcc->dev;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2485) struct idt77252_dev *card = dev->dev_data;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2486) struct vc_map *vc = vcc->dev_data;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2487) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2488) unsigned long addr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2489) unsigned long timeout;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2490)
7e7a2d07b0faf (Matthias Kaehlcke 2007-05-23 14:45:45 -0700 2491) mutex_lock(&card->mutex);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2492)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2493) IPRINTK("%s: idt77252_close: vc = %d (%d.%d)\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2494) card->name, vc->index, vcc->vpi, vcc->vci);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2495)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2496) clear_bit(ATM_VF_READY, &vcc->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2497)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2498) if (vcc->qos.rxtp.traffic_class != ATM_NONE) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2499)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2500) spin_lock_irqsave(&vc->lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2501) clear_bit(VCF_RX, &vc->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2502) vc->rx_vcc = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2503) spin_unlock_irqrestore(&vc->lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2504)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2505) if ((vcc->vci == 3) || (vcc->vci == 4))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2506) goto done;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2507)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2508) addr = card->rct_base + vc->index * SAR_SRAM_RCT_SIZE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2509)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2510) spin_lock_irqsave(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2511) writel(SAR_CMD_CLOSE_CONNECTION | (addr << 2), SAR_REG_CMD);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2512) waitfor_idle(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2513) spin_unlock_irqrestore(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2514)
ceade961c4c8d (David S. Miller 2008-09-21 21:38:26 -0700 2515) if (skb_queue_len(&vc->rcv.rx_pool.queue) != 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2516) DPRINTK("%s: closing a VC with pending rx buffers.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2517) card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2518)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2519) recycle_rx_pool_skb(card, &vc->rcv.rx_pool);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2520) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2521) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2522)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2523) done:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2524) if (vcc->qos.txtp.traffic_class != ATM_NONE) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2525)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2526) spin_lock_irqsave(&vc->lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2527) clear_bit(VCF_TX, &vc->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2528) clear_bit(VCF_IDLE, &vc->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2529) clear_bit(VCF_RSV, &vc->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2530) vc->tx_vcc = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2531)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2532) if (vc->estimator) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2533) del_timer(&vc->estimator->timer);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2534) kfree(vc->estimator);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2535) vc->estimator = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2536) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2537) spin_unlock_irqrestore(&vc->lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2538)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2539) timeout = 5 * 1000;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2540) while (atomic_read(&vc->scq->used) > 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2541) timeout = msleep_interruptible(timeout);
7e910357f620b (Peter Senna Tschudin 2014-05-19 12:26:52 +0200 2542) if (!timeout) {
7e910357f620b (Peter Senna Tschudin 2014-05-19 12:26:52 +0200 2543) pr_warn("%s: SCQ drain timeout: %u used\n",
7e910357f620b (Peter Senna Tschudin 2014-05-19 12:26:52 +0200 2544) card->name, atomic_read(&vc->scq->used));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2545) break;
7e910357f620b (Peter Senna Tschudin 2014-05-19 12:26:52 +0200 2546) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2547) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2548)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2549) writel(TCMDQ_HALT | vc->index, SAR_REG_TCMDQ);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2550) clear_scd(card, vc->scq, vc->class);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2551)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2552) if (vc->class == SCHED_CBR) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2553) clear_tst(card, vc);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2554) card->tst_free += vc->ntste;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2555) vc->ntste = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2556) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2557)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2558) card->scd2vc[vc->scd_index] = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2559) free_scq(card, vc->scq);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2560) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2561)
7e7a2d07b0faf (Matthias Kaehlcke 2007-05-23 14:45:45 -0700 2562) mutex_unlock(&card->mutex);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2563) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2564)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2565) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2566) idt77252_change_qos(struct atm_vcc *vcc, struct atm_qos *qos, int flags)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2567) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2568) struct atm_dev *dev = vcc->dev;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2569) struct idt77252_dev *card = dev->dev_data;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2570) struct vc_map *vc = vcc->dev_data;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2571) int error = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2572)
7e7a2d07b0faf (Matthias Kaehlcke 2007-05-23 14:45:45 -0700 2573) mutex_lock(&card->mutex);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2574)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2575) if (qos->txtp.traffic_class != ATM_NONE) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2576) if (!test_bit(VCF_TX, &vc->flags)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2577) error = idt77252_init_tx(card, vc, vcc, qos);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2578) if (error)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2579) goto out;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2580) } else {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2581) switch (qos->txtp.traffic_class) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2582) case ATM_CBR:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2583) error = idt77252_init_cbr(card, vc, vcc, qos);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2584) if (error)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2585) goto out;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2586) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2587)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2588) case ATM_UBR:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2589) error = idt77252_init_ubr(card, vc, vcc, qos);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2590) if (error)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2591) goto out;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2592)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2593) if (!test_bit(VCF_IDLE, &vc->flags)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2594) writel(TCMDQ_LACR | (vc->lacr << 16) |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2595) vc->index, SAR_REG_TCMDQ);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2596) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2597) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2598)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2599) case ATM_VBR:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2600) case ATM_ABR:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2601) error = -EOPNOTSUPP;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2602) goto out;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2603) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2604) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2605) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2606)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2607) if ((qos->rxtp.traffic_class != ATM_NONE) &&
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2608) !test_bit(VCF_RX, &vc->flags)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2609) error = idt77252_init_rx(card, vc, vcc, qos);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2610) if (error)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2611) goto out;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2612) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2613)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2614) memcpy(&vcc->qos, qos, sizeof(struct atm_qos));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2615)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2616) set_bit(ATM_VF_HASQOS, &vcc->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2617)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2618) out:
7e7a2d07b0faf (Matthias Kaehlcke 2007-05-23 14:45:45 -0700 2619) mutex_unlock(&card->mutex);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2620) return error;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2621) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2622)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2623) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2624) idt77252_proc_read(struct atm_dev *dev, loff_t * pos, char *page)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2625) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2626) struct idt77252_dev *card = dev->dev_data;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2627) int i, left;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2628)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2629) left = (int) *pos;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2630) if (!left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2631) return sprintf(page, "IDT77252 Interrupts:\n");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2632) if (!left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2633) return sprintf(page, "TSIF: %lu\n", card->irqstat[15]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2634) if (!left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2635) return sprintf(page, "TXICP: %lu\n", card->irqstat[14]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2636) if (!left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2637) return sprintf(page, "TSQF: %lu\n", card->irqstat[12]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2638) if (!left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2639) return sprintf(page, "TMROF: %lu\n", card->irqstat[11]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2640) if (!left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2641) return sprintf(page, "PHYI: %lu\n", card->irqstat[10]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2642) if (!left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2643) return sprintf(page, "FBQ3A: %lu\n", card->irqstat[8]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2644) if (!left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2645) return sprintf(page, "FBQ2A: %lu\n", card->irqstat[7]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2646) if (!left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2647) return sprintf(page, "RSQF: %lu\n", card->irqstat[6]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2648) if (!left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2649) return sprintf(page, "EPDU: %lu\n", card->irqstat[5]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2650) if (!left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2651) return sprintf(page, "RAWCF: %lu\n", card->irqstat[4]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2652) if (!left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2653) return sprintf(page, "FBQ1A: %lu\n", card->irqstat[3]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2654) if (!left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2655) return sprintf(page, "FBQ0A: %lu\n", card->irqstat[2]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2656) if (!left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2657) return sprintf(page, "RSQAF: %lu\n", card->irqstat[1]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2658) if (!left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2659) return sprintf(page, "IDT77252 Transmit Connection Table:\n");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2660)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2661) for (i = 0; i < card->tct_size; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2662) unsigned long tct;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2663) struct atm_vcc *vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2664) struct vc_map *vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2665) char *p;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2666)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2667) vc = card->vcs[i];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2668) if (!vc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2669) continue;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2670)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2671) vcc = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2672) if (vc->tx_vcc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2673) vcc = vc->tx_vcc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2674) if (!vcc)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2675) continue;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2676) if (left--)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2677) continue;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2678)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2679) p = page;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2680) p += sprintf(p, " %4u: %u.%u: ", i, vcc->vpi, vcc->vci);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2681) tct = (unsigned long) (card->tct_base + i * SAR_SRAM_TCT_SIZE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2682)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2683) for (i = 0; i < 8; i++)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2684) p += sprintf(p, " %08x", read_sram(card, tct + i));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2685) p += sprintf(p, "\n");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2686) return p - page;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2687) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2688) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2689) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2690)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2691) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2692) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2693) /* Interrupt handler */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2694) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2695) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2696)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2697) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2698) idt77252_collect_stat(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2699) {
edb4dcb717d71 (David S. Miller 2011-04-17 00:10:17 -0700 2700) (void) readl(SAR_REG_CDC);
edb4dcb717d71 (David S. Miller 2011-04-17 00:10:17 -0700 2701) (void) readl(SAR_REG_VPEC);
edb4dcb717d71 (David S. Miller 2011-04-17 00:10:17 -0700 2702) (void) readl(SAR_REG_ICC);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2703)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2704) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2705)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2706) static irqreturn_t
7d12e780e003f (David Howells 2006-10-05 14:55:46 +0100 2707) idt77252_interrupt(int irq, void *dev_id)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2708) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2709) struct idt77252_dev *card = dev_id;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2710) u32 stat;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2711)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2712) stat = readl(SAR_REG_STAT) & 0xffff;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2713) if (!stat) /* no interrupt for us */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2714) return IRQ_NONE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2715)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2716) if (test_and_set_bit(IDT77252_BIT_INTERRUPT, &card->flags)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2717) printk("%s: Re-entering irq_handler()\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2718) goto out;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2719) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2720)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2721) writel(stat, SAR_REG_STAT); /* reset interrupt */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2722)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2723) if (stat & SAR_STAT_TSIF) { /* entry written to TSQ */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2724) INTPRINTK("%s: TSIF\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2725) card->irqstat[15]++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2726) idt77252_tx(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2727) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2728) if (stat & SAR_STAT_TXICP) { /* Incomplete CS-PDU has */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2729) INTPRINTK("%s: TXICP\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2730) card->irqstat[14]++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2731) #ifdef CONFIG_ATM_IDT77252_DEBUG
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2732) idt77252_tx_dump(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2733) #endif
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2734) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2735) if (stat & SAR_STAT_TSQF) { /* TSQ 7/8 full */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2736) INTPRINTK("%s: TSQF\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2737) card->irqstat[12]++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2738) idt77252_tx(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2739) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2740) if (stat & SAR_STAT_TMROF) { /* Timer overflow */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2741) INTPRINTK("%s: TMROF\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2742) card->irqstat[11]++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2743) idt77252_collect_stat(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2744) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2745)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2746) if (stat & SAR_STAT_EPDU) { /* Got complete CS-PDU */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2747) INTPRINTK("%s: EPDU\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2748) card->irqstat[5]++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2749) idt77252_rx(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2750) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2751) if (stat & SAR_STAT_RSQAF) { /* RSQ is 7/8 full */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2752) INTPRINTK("%s: RSQAF\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2753) card->irqstat[1]++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2754) idt77252_rx(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2755) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2756) if (stat & SAR_STAT_RSQF) { /* RSQ is full */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2757) INTPRINTK("%s: RSQF\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2758) card->irqstat[6]++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2759) idt77252_rx(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2760) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2761) if (stat & SAR_STAT_RAWCF) { /* Raw cell received */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2762) INTPRINTK("%s: RAWCF\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2763) card->irqstat[4]++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2764) idt77252_rx_raw(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2765) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2766)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2767) if (stat & SAR_STAT_PHYI) { /* PHY device interrupt */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2768) INTPRINTK("%s: PHYI", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2769) card->irqstat[10]++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2770) if (card->atmdev->phy && card->atmdev->phy->interrupt)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2771) card->atmdev->phy->interrupt(card->atmdev);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2772) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2773)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2774) if (stat & (SAR_STAT_FBQ0A | SAR_STAT_FBQ1A |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2775) SAR_STAT_FBQ2A | SAR_STAT_FBQ3A)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2776)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2777) writel(readl(SAR_REG_CFG) & ~(SAR_CFG_FBIE), SAR_REG_CFG);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2778)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2779) INTPRINTK("%s: FBQA: %04x\n", card->name, stat);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2780)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2781) if (stat & SAR_STAT_FBQ0A)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2782) card->irqstat[2]++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2783) if (stat & SAR_STAT_FBQ1A)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2784) card->irqstat[3]++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2785) if (stat & SAR_STAT_FBQ2A)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2786) card->irqstat[7]++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2787) if (stat & SAR_STAT_FBQ3A)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2788) card->irqstat[8]++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2789)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2790) schedule_work(&card->tqueue);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2791) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2792)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2793) out:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2794) clear_bit(IDT77252_BIT_INTERRUPT, &card->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2795) return IRQ_HANDLED;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2796) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2797)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2798) static void
c4028958b6eca (David Howells 2006-11-22 14:57:56 +0000 2799) idt77252_softint(struct work_struct *work)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2800) {
c4028958b6eca (David Howells 2006-11-22 14:57:56 +0000 2801) struct idt77252_dev *card =
c4028958b6eca (David Howells 2006-11-22 14:57:56 +0000 2802) container_of(work, struct idt77252_dev, tqueue);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2803) u32 stat;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2804) int done;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2805)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2806) for (done = 1; ; done = 1) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2807) stat = readl(SAR_REG_STAT) >> 16;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2808)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2809) if ((stat & 0x0f) < SAR_FBQ0_HIGH) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2810) add_rx_skb(card, 0, SAR_FB_SIZE_0, 32);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2811) done = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2812) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2813)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2814) stat >>= 4;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2815) if ((stat & 0x0f) < SAR_FBQ1_HIGH) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2816) add_rx_skb(card, 1, SAR_FB_SIZE_1, 32);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2817) done = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2818) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2819)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2820) stat >>= 4;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2821) if ((stat & 0x0f) < SAR_FBQ2_HIGH) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2822) add_rx_skb(card, 2, SAR_FB_SIZE_2, 32);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2823) done = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2824) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2825)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2826) stat >>= 4;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2827) if ((stat & 0x0f) < SAR_FBQ3_HIGH) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2828) add_rx_skb(card, 3, SAR_FB_SIZE_3, 32);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2829) done = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2830) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2831)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2832) if (done)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2833) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2834) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2835)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2836) writel(readl(SAR_REG_CFG) | SAR_CFG_FBIE, SAR_REG_CFG);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2837) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2838)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2839)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2840) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2841) open_card_oam(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2842) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2843) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2844) unsigned long addr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2845) struct vc_map *vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2846) int vpi, vci;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2847) int index;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2848) u32 rcte;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2849)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2850) for (vpi = 0; vpi < (1 << card->vpibits); vpi++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2851) for (vci = 3; vci < 5; vci++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2852) index = VPCI2VC(card, vpi, vci);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2853)
0c1cca1d8e0d5 (Om Narasimhan 2006-10-03 16:27:18 -0700 2854) vc = kzalloc(sizeof(struct vc_map), GFP_KERNEL);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2855) if (!vc) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2856) printk("%s: can't alloc vc\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2857) return -ENOMEM;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2858) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2859) vc->index = index;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2860) card->vcs[index] = vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2861)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2862) flush_rx_pool(card, &vc->rcv.rx_pool);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2863)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2864) rcte = SAR_RCTE_CONNECTOPEN |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2865) SAR_RCTE_RAWCELLINTEN |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2866) SAR_RCTE_RCQ |
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2867) SAR_RCTE_FBP_1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2868)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2869) addr = card->rct_base + (vc->index << 2);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2870) write_sram(card, addr, rcte);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2871)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2872) spin_lock_irqsave(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2873) writel(SAR_CMD_OPEN_CONNECTION | (addr << 2),
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2874) SAR_REG_CMD);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2875) waitfor_idle(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2876) spin_unlock_irqrestore(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2877) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2878) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2879)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2880) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2881) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2882)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2883) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2884) close_card_oam(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2885) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2886) unsigned long flags;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2887) unsigned long addr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2888) struct vc_map *vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2889) int vpi, vci;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2890) int index;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2891)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2892) for (vpi = 0; vpi < (1 << card->vpibits); vpi++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2893) for (vci = 3; vci < 5; vci++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2894) index = VPCI2VC(card, vpi, vci);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2895) vc = card->vcs[index];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2896)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2897) addr = card->rct_base + vc->index * SAR_SRAM_RCT_SIZE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2898)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2899) spin_lock_irqsave(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2900) writel(SAR_CMD_CLOSE_CONNECTION | (addr << 2),
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2901) SAR_REG_CMD);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2902) waitfor_idle(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2903) spin_unlock_irqrestore(&card->cmd_lock, flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2904)
ceade961c4c8d (David S. Miller 2008-09-21 21:38:26 -0700 2905) if (skb_queue_len(&vc->rcv.rx_pool.queue) != 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2906) DPRINTK("%s: closing a VC "
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2907) "with pending rx buffers.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2908) card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2909)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2910) recycle_rx_pool_skb(card, &vc->rcv.rx_pool);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2911) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2912) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2913) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2914) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2915)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2916) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2917) open_card_ubr0(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2918) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2919) struct vc_map *vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2920)
0c1cca1d8e0d5 (Om Narasimhan 2006-10-03 16:27:18 -0700 2921) vc = kzalloc(sizeof(struct vc_map), GFP_KERNEL);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2922) if (!vc) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2923) printk("%s: can't alloc vc\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2924) return -ENOMEM;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2925) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2926) card->vcs[0] = vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2927) vc->class = SCHED_UBR0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2928)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2929) vc->scq = alloc_scq(card, vc->class);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2930) if (!vc->scq) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2931) printk("%s: can't get SCQ.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2932) return -ENOMEM;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2933) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2934)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2935) card->scd2vc[0] = vc;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2936) vc->scd_index = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2937) vc->scq->scd = card->scd_base;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2938)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2939) fill_scd(card, vc->scq, vc->class);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2940)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2941) write_sram(card, card->tct_base + 0, TCT_UBR | card->scd_base);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2942) write_sram(card, card->tct_base + 1, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2943) write_sram(card, card->tct_base + 2, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2944) write_sram(card, card->tct_base + 3, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2945) write_sram(card, card->tct_base + 4, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2946) write_sram(card, card->tct_base + 5, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2947) write_sram(card, card->tct_base + 6, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2948) write_sram(card, card->tct_base + 7, TCT_FLAG_UBR);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2949)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2950) clear_bit(VCF_IDLE, &vc->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2951) writel(TCMDQ_START | 0, SAR_REG_TCMDQ);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2952) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2953) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2954)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2955) static int
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2956) idt77252_dev_open(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2957) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2958) u32 conf;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2959)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2960) if (!test_bit(IDT77252_BIT_INIT, &card->flags)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2961) printk("%s: SAR not yet initialized.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2962) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2963) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2964)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2965) conf = SAR_CFG_RXPTH| /* enable receive path */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2966) SAR_RX_DELAY | /* interrupt on complete PDU */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2967) SAR_CFG_RAWIE | /* interrupt enable on raw cells */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2968) SAR_CFG_RQFIE | /* interrupt on RSQ almost full */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2969) SAR_CFG_TMOIE | /* interrupt on timer overflow */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2970) SAR_CFG_FBIE | /* interrupt on low free buffers */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2971) SAR_CFG_TXEN | /* transmit operation enable */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2972) SAR_CFG_TXINT | /* interrupt on transmit status */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2973) SAR_CFG_TXUIE | /* interrupt on transmit underrun */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2974) SAR_CFG_TXSFI | /* interrupt on TSQ almost full */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2975) SAR_CFG_PHYIE /* enable PHY interrupts */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2976) ;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2977)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2978) #ifdef CONFIG_ATM_IDT77252_RCV_ALL
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2979) /* Test RAW cell receive. */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2980) conf |= SAR_CFG_VPECA;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2981) #endif
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2982)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2983) writel(readl(SAR_REG_CFG) | conf, SAR_REG_CFG);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2984)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2985) if (open_card_oam(card)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2986) printk("%s: Error initializing OAM.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2987) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2988) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2989)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2990) if (open_card_ubr0(card)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2991) printk("%s: Error initializing UBR0.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2992) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2993) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2994)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2995) IPRINTK("%s: opened IDT77252 ABR SAR.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2996) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2997) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 2998)
f4c4b4a63153d (Adrian Bunk 2008-03-31 19:35:52 -0700 2999) static void idt77252_dev_close(struct atm_dev *dev)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3000) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3001) struct idt77252_dev *card = dev->dev_data;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3002) u32 conf;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3003)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3004) close_card_oam(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3005)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3006) conf = SAR_CFG_RXPTH | /* enable receive path */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3007) SAR_RX_DELAY | /* interrupt on complete PDU */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3008) SAR_CFG_RAWIE | /* interrupt enable on raw cells */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3009) SAR_CFG_RQFIE | /* interrupt on RSQ almost full */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3010) SAR_CFG_TMOIE | /* interrupt on timer overflow */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3011) SAR_CFG_FBIE | /* interrupt on low free buffers */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3012) SAR_CFG_TXEN | /* transmit operation enable */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3013) SAR_CFG_TXINT | /* interrupt on transmit status */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3014) SAR_CFG_TXUIE | /* interrupt on xmit underrun */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3015) SAR_CFG_TXSFI /* interrupt on TSQ almost full */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3016) ;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3017)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3018) writel(readl(SAR_REG_CFG) & ~(conf), SAR_REG_CFG);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3019)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3020) DIPRINTK("%s: closed IDT77252 ABR SAR.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3021) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3022)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3023)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3024) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3025) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3026) /* Initialisation and Deinitialization of IDT77252 */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3027) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3028) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3029)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3030)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3031) static void
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3032) deinit_card(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3033) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3034) struct sk_buff *skb;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3035) int i, j;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3036)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3037) if (!test_bit(IDT77252_BIT_INIT, &card->flags)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3038) printk("%s: SAR not yet initialized.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3039) return;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3040) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3041) DIPRINTK("idt77252: deinitialize card %u\n", card->index);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3042)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3043) writel(0, SAR_REG_CFG);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3044)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3045) if (card->atmdev)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3046) atm_dev_deregister(card->atmdev);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3047)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3048) for (i = 0; i < 4; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3049) for (j = 0; j < FBQ_SIZE; j++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3050) skb = card->sbpool[i].skb[j];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3051) if (skb) {
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 3052) dma_unmap_single(&card->pcidev->dev,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3053) IDT77252_PRV_PADDR(skb),
4305b541357dd (Arnaldo Carvalho de Melo 2007-04-19 20:43:29 -0700 3054) (skb_end_pointer(skb) -
4305b541357dd (Arnaldo Carvalho de Melo 2007-04-19 20:43:29 -0700 3055) skb->data),
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 3056) DMA_FROM_DEVICE);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3057) card->sbpool[i].skb[j] = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3058) dev_kfree_skb(skb);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3059) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3060) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3061) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3062)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3063) vfree(card->soft_tst);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3064)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3065) vfree(card->scd2vc);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3066)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3067) vfree(card->vcs);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3068)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3069) if (card->raw_cell_hnd) {
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 3070) dma_free_coherent(&card->pcidev->dev, 2 * sizeof(u32),
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 3071) card->raw_cell_hnd, card->raw_cell_paddr);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3072) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3073)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3074) if (card->rsq.base) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3075) DIPRINTK("%s: Release RSQ ...\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3076) deinit_rsq(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3077) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3078)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3079) if (card->tsq.base) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3080) DIPRINTK("%s: Release TSQ ...\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3081) deinit_tsq(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3082) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3083)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3084) DIPRINTK("idt77252: Release IRQ.\n");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3085) free_irq(card->pcidev->irq, card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3086)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3087) for (i = 0; i < 4; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3088) if (card->fbq[i])
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3089) iounmap(card->fbq[i]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3090) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3091)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3092) if (card->membase)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3093) iounmap(card->membase);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3094)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3095) clear_bit(IDT77252_BIT_INIT, &card->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3096) DIPRINTK("%s: Card deinitialized.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3097) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3098)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3099)
6c44512d06d3f (Greg Kroah-Hartman 2012-12-21 13:25:04 -0800 3100) static void init_sram(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3101) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3102) int i;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3103)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3104) for (i = 0; i < card->sramsize; i += 4)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3105) write_sram(card, (i >> 2), 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3106)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3107) /* set SRAM layout for THIS card */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3108) if (card->sramsize == (512 * 1024)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3109) card->tct_base = SAR_SRAM_TCT_128_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3110) card->tct_size = (SAR_SRAM_TCT_128_TOP - card->tct_base + 1)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3111) / SAR_SRAM_TCT_SIZE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3112) card->rct_base = SAR_SRAM_RCT_128_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3113) card->rct_size = (SAR_SRAM_RCT_128_TOP - card->rct_base + 1)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3114) / SAR_SRAM_RCT_SIZE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3115) card->rt_base = SAR_SRAM_RT_128_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3116) card->scd_base = SAR_SRAM_SCD_128_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3117) card->scd_size = (SAR_SRAM_SCD_128_TOP - card->scd_base + 1)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3118) / SAR_SRAM_SCD_SIZE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3119) card->tst[0] = SAR_SRAM_TST1_128_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3120) card->tst[1] = SAR_SRAM_TST2_128_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3121) card->tst_size = SAR_SRAM_TST1_128_TOP - card->tst[0] + 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3122) card->abrst_base = SAR_SRAM_ABRSTD_128_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3123) card->abrst_size = SAR_ABRSTD_SIZE_8K;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3124) card->fifo_base = SAR_SRAM_FIFO_128_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3125) card->fifo_size = SAR_RXFD_SIZE_32K;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3126) } else {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3127) card->tct_base = SAR_SRAM_TCT_32_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3128) card->tct_size = (SAR_SRAM_TCT_32_TOP - card->tct_base + 1)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3129) / SAR_SRAM_TCT_SIZE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3130) card->rct_base = SAR_SRAM_RCT_32_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3131) card->rct_size = (SAR_SRAM_RCT_32_TOP - card->rct_base + 1)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3132) / SAR_SRAM_RCT_SIZE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3133) card->rt_base = SAR_SRAM_RT_32_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3134) card->scd_base = SAR_SRAM_SCD_32_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3135) card->scd_size = (SAR_SRAM_SCD_32_TOP - card->scd_base + 1)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3136) / SAR_SRAM_SCD_SIZE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3137) card->tst[0] = SAR_SRAM_TST1_32_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3138) card->tst[1] = SAR_SRAM_TST2_32_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3139) card->tst_size = (SAR_SRAM_TST1_32_TOP - card->tst[0] + 1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3140) card->abrst_base = SAR_SRAM_ABRSTD_32_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3141) card->abrst_size = SAR_ABRSTD_SIZE_1K;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3142) card->fifo_base = SAR_SRAM_FIFO_32_BASE;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3143) card->fifo_size = SAR_RXFD_SIZE_4K;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3144) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3145)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3146) /* Initialize TCT */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3147) for (i = 0; i < card->tct_size; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3148) write_sram(card, i * SAR_SRAM_TCT_SIZE + 0, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3149) write_sram(card, i * SAR_SRAM_TCT_SIZE + 1, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3150) write_sram(card, i * SAR_SRAM_TCT_SIZE + 2, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3151) write_sram(card, i * SAR_SRAM_TCT_SIZE + 3, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3152) write_sram(card, i * SAR_SRAM_TCT_SIZE + 4, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3153) write_sram(card, i * SAR_SRAM_TCT_SIZE + 5, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3154) write_sram(card, i * SAR_SRAM_TCT_SIZE + 6, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3155) write_sram(card, i * SAR_SRAM_TCT_SIZE + 7, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3156) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3157)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3158) /* Initialize RCT */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3159) for (i = 0; i < card->rct_size; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3160) write_sram(card, card->rct_base + i * SAR_SRAM_RCT_SIZE,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3161) (u32) SAR_RCTE_RAWCELLINTEN);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3162) write_sram(card, card->rct_base + i * SAR_SRAM_RCT_SIZE + 1,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3163) (u32) 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3164) write_sram(card, card->rct_base + i * SAR_SRAM_RCT_SIZE + 2,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3165) (u32) 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3166) write_sram(card, card->rct_base + i * SAR_SRAM_RCT_SIZE + 3,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3167) (u32) 0xffffffff);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3168) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3169)
3c69f79233e7c (Colin Ian King 2018-02-23 12:22:52 +0000 3170) writel((SAR_FBQ0_LOW << 28) | (SAR_FB_SIZE_0 / 48), SAR_REG_FBQS0);
3c69f79233e7c (Colin Ian King 2018-02-23 12:22:52 +0000 3171) writel((SAR_FBQ1_LOW << 28) | (SAR_FB_SIZE_1 / 48), SAR_REG_FBQS1);
3c69f79233e7c (Colin Ian King 2018-02-23 12:22:52 +0000 3172) writel((SAR_FBQ2_LOW << 28) | (SAR_FB_SIZE_2 / 48), SAR_REG_FBQS2);
3c69f79233e7c (Colin Ian King 2018-02-23 12:22:52 +0000 3173) writel((SAR_FBQ3_LOW << 28) | (SAR_FB_SIZE_3 / 48), SAR_REG_FBQS3);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3174)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3175) /* Initialize rate table */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3176) for (i = 0; i < 256; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3177) write_sram(card, card->rt_base + i, log_to_rate[i]);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3178) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3179)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3180) for (i = 0; i < 128; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3181) unsigned int tmp;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3182)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3183) tmp = rate_to_log[(i << 2) + 0] << 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3184) tmp |= rate_to_log[(i << 2) + 1] << 8;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3185) tmp |= rate_to_log[(i << 2) + 2] << 16;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3186) tmp |= rate_to_log[(i << 2) + 3] << 24;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3187) write_sram(card, card->rt_base + 256 + i, tmp);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3188) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3189)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3190) #if 0 /* Fill RDF and AIR tables. */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3191) for (i = 0; i < 128; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3192) unsigned int tmp;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3193)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3194) tmp = RDF[0][(i << 1) + 0] << 16;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3195) tmp |= RDF[0][(i << 1) + 1] << 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3196) write_sram(card, card->rt_base + 512 + i, tmp);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3197) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3198)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3199) for (i = 0; i < 128; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3200) unsigned int tmp;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3201)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3202) tmp = AIR[0][(i << 1) + 0] << 16;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3203) tmp |= AIR[0][(i << 1) + 1] << 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3204) write_sram(card, card->rt_base + 640 + i, tmp);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3205) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3206) #endif
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3207)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3208) IPRINTK("%s: initialize rate table ...\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3209) writel(card->rt_base << 2, SAR_REG_RTBL);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3210)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3211) /* Initialize TSTs */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3212) IPRINTK("%s: initialize TST ...\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3213) card->tst_free = card->tst_size - 2; /* last two are jumps */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3214)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3215) for (i = card->tst[0]; i < card->tst[0] + card->tst_size - 2; i++)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3216) write_sram(card, i, TSTE_OPC_VAR);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3217) write_sram(card, i++, TSTE_OPC_JMP | (card->tst[0] << 2));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3218) idt77252_sram_write_errors = 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3219) write_sram(card, i++, TSTE_OPC_JMP | (card->tst[1] << 2));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3220) idt77252_sram_write_errors = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3221) for (i = card->tst[1]; i < card->tst[1] + card->tst_size - 2; i++)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3222) write_sram(card, i, TSTE_OPC_VAR);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3223) write_sram(card, i++, TSTE_OPC_JMP | (card->tst[1] << 2));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3224) idt77252_sram_write_errors = 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3225) write_sram(card, i++, TSTE_OPC_JMP | (card->tst[0] << 2));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3226) idt77252_sram_write_errors = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3227)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3228) card->tst_index = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3229) writel(card->tst[0] << 2, SAR_REG_TSTB);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3230)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3231) /* Initialize ABRSTD and Receive FIFO */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3232) IPRINTK("%s: initialize ABRSTD ...\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3233) writel(card->abrst_size | (card->abrst_base << 2),
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3234) SAR_REG_ABRSTD);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3235)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3236) IPRINTK("%s: initialize receive fifo ...\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3237) writel(card->fifo_size | (card->fifo_base << 2),
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3238) SAR_REG_RXFD);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3239)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3240) IPRINTK("%s: SRAM initialization complete.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3241) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3242)
6c44512d06d3f (Greg Kroah-Hartman 2012-12-21 13:25:04 -0800 3243) static int init_card(struct atm_dev *dev)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3244) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3245) struct idt77252_dev *card = dev->dev_data;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3246) struct pci_dev *pcidev = card->pcidev;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3247) unsigned long tmpl, modl;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3248) unsigned int linkrate, rsvdcr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3249) unsigned int tst_entries;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3250) struct net_device *tmp;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3251) char tname[10];
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3252)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3253) u32 size;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3254) u_char pci_byte;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3255) u32 conf;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3256) int i, k;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3257)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3258) if (test_bit(IDT77252_BIT_INIT, &card->flags)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3259) printk("Error: SAR already initialized.\n");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3260) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3261) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3262)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3263) /*****************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3264) /* P C I C O N F I G U R A T I O N */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3265) /*****************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3266)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3267) /* Set PCI Retry-Timeout and TRDY timeout */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3268) IPRINTK("%s: Checking PCI retries.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3269) if (pci_read_config_byte(pcidev, 0x40, &pci_byte) != 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3270) printk("%s: can't read PCI retry timeout.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3271) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3272) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3273) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3274) if (pci_byte != 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3275) IPRINTK("%s: PCI retry timeout: %d, set to 0.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3276) card->name, pci_byte);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3277) if (pci_write_config_byte(pcidev, 0x40, 0) != 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3278) printk("%s: can't set PCI retry timeout.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3279) card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3280) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3281) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3282) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3283) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3284) IPRINTK("%s: Checking PCI TRDY.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3285) if (pci_read_config_byte(pcidev, 0x41, &pci_byte) != 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3286) printk("%s: can't read PCI TRDY timeout.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3287) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3288) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3289) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3290) if (pci_byte != 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3291) IPRINTK("%s: PCI TRDY timeout: %d, set to 0.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3292) card->name, pci_byte);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3293) if (pci_write_config_byte(pcidev, 0x41, 0) != 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3294) printk("%s: can't set PCI TRDY timeout.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3295) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3296) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3297) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3298) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3299) /* Reset Timer register */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3300) if (readl(SAR_REG_STAT) & SAR_STAT_TMROF) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3301) printk("%s: resetting timer overflow.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3302) writel(SAR_STAT_TMROF, SAR_REG_STAT);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3303) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3304) IPRINTK("%s: Request IRQ ... ", card->name);
06df277a67026 (chas williams - CONTRACTOR 2010-07-10 03:42:02 +0000 3305) if (request_irq(pcidev->irq, idt77252_interrupt, IRQF_SHARED,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3306) card->name, card) != 0) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3307) printk("%s: can't allocate IRQ.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3308) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3309) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3310) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3311) IPRINTK("got %d.\n", pcidev->irq);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3312)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3313) /*****************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3314) /* C H E C K A N D I N I T S R A M */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3315) /*****************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3316)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3317) IPRINTK("%s: Initializing SRAM\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3318)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3319) /* preset size of connecton table, so that init_sram() knows about it */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3320) conf = SAR_CFG_TX_FIFO_SIZE_9 | /* Use maximum fifo size */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3321) SAR_CFG_RXSTQ_SIZE_8k | /* Receive Status Queue is 8k */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3322) SAR_CFG_IDLE_CLP | /* Set CLP on idle cells */
44beac008631d (Robert P. J. Day 2007-07-16 18:35:07 -0700 3323) #ifndef ATM_IDT77252_SEND_IDLE
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3324) SAR_CFG_NO_IDLE | /* Do not send idle cells */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3325) #endif
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3326) 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3327)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3328) if (card->sramsize == (512 * 1024))
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3329) conf |= SAR_CFG_CNTBL_1k;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3330) else
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3331) conf |= SAR_CFG_CNTBL_512;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3332)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3333) switch (vpibits) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3334) case 0:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3335) conf |= SAR_CFG_VPVCS_0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3336) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3337) default:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3338) case 1:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3339) conf |= SAR_CFG_VPVCS_1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3340) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3341) case 2:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3342) conf |= SAR_CFG_VPVCS_2;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3343) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3344) case 8:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3345) conf |= SAR_CFG_VPVCS_8;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3346) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3347) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3348)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3349) writel(readl(SAR_REG_CFG) | conf, SAR_REG_CFG);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3350)
1790c228fb3f5 (Julia Lawall 2010-10-02 04:37:07 +0000 3351) init_sram(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3352)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3353) /********************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3354) /* A L L O C R A M A N D S E T V A R I O U S T H I N G S */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3355) /********************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3356) /* Initialize TSQ */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3357) if (0 != init_tsq(card)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3358) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3359) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3360) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3361) /* Initialize RSQ */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3362) if (0 != init_rsq(card)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3363) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3364) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3365) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3366)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3367) card->vpibits = vpibits;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3368) if (card->sramsize == (512 * 1024)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3369) card->vcibits = 10 - card->vpibits;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3370) } else {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3371) card->vcibits = 9 - card->vpibits;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3372) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3373)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3374) card->vcimask = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3375) for (k = 0, i = 1; k < card->vcibits; k++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3376) card->vcimask |= i;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3377) i <<= 1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3378) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3379)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3380) IPRINTK("%s: Setting VPI/VCI mask to zero.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3381) writel(0, SAR_REG_VPM);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3382)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3383) /* Little Endian Order */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3384) writel(0, SAR_REG_GP);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3385)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3386) /* Initialize RAW Cell Handle Register */
750afb08ca713 (Luis Chamberlain 2019-01-04 09:23:09 +0100 3387) card->raw_cell_hnd = dma_alloc_coherent(&card->pcidev->dev,
750afb08ca713 (Luis Chamberlain 2019-01-04 09:23:09 +0100 3388) 2 * sizeof(u32),
750afb08ca713 (Luis Chamberlain 2019-01-04 09:23:09 +0100 3389) &card->raw_cell_paddr,
750afb08ca713 (Luis Chamberlain 2019-01-04 09:23:09 +0100 3390) GFP_KERNEL);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3391) if (!card->raw_cell_hnd) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3392) printk("%s: memory allocation failure.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3393) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3394) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3395) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3396) writel(card->raw_cell_paddr, SAR_REG_RAWHND);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3397) IPRINTK("%s: raw cell handle is at 0x%p.\n", card->name,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3398) card->raw_cell_hnd);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3399)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3400) size = sizeof(struct vc_map *) * card->tct_size;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3401) IPRINTK("%s: allocate %d byte for VC map.\n", card->name, size);
3a816054fcd34 (Joe Perches 2011-05-28 10:36:23 -0700 3402) card->vcs = vzalloc(size);
3a816054fcd34 (Joe Perches 2011-05-28 10:36:23 -0700 3403) if (!card->vcs) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3404) printk("%s: memory allocation failure.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3405) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3406) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3407) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3408)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3409) size = sizeof(struct vc_map *) * card->scd_size;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3410) IPRINTK("%s: allocate %d byte for SCD to VC mapping.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3411) card->name, size);
3a816054fcd34 (Joe Perches 2011-05-28 10:36:23 -0700 3412) card->scd2vc = vzalloc(size);
3a816054fcd34 (Joe Perches 2011-05-28 10:36:23 -0700 3413) if (!card->scd2vc) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3414) printk("%s: memory allocation failure.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3415) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3416) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3417) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3418)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3419) size = sizeof(struct tst_info) * (card->tst_size - 2);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3420) IPRINTK("%s: allocate %d byte for TST to VC mapping.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3421) card->name, size);
3a816054fcd34 (Joe Perches 2011-05-28 10:36:23 -0700 3422) card->soft_tst = vmalloc(size);
3a816054fcd34 (Joe Perches 2011-05-28 10:36:23 -0700 3423) if (!card->soft_tst) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3424) printk("%s: memory allocation failure.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3425) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3426) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3427) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3428) for (i = 0; i < card->tst_size - 2; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3429) card->soft_tst[i].tste = TSTE_OPC_VAR;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3430) card->soft_tst[i].vc = NULL;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3431) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3432)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3433) if (dev->phy == NULL) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3434) printk("%s: No LT device defined.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3435) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3436) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3437) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3438) if (dev->phy->ioctl == NULL) {
25985edcedea6 (Lucas De Marchi 2011-03-30 22:57:33 -0300 3439) printk("%s: LT had no IOCTL function defined.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3440) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3441) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3442) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3443)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3444) #ifdef CONFIG_ATM_IDT77252_USE_SUNI
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3445) /*
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3446) * this is a jhs hack to get around special functionality in the
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3447) * phy driver for the atecom hardware; the functionality doesn't
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3448) * exist in the linux atm suni driver
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3449) *
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3450) * it isn't the right way to do things, but as the guy from NIST
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3451) * said, talking about their measurement of the fine structure
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3452) * constant, "it's good enough for government work."
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3453) */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3454) linkrate = 149760000;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3455) #endif
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3456)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3457) card->link_pcr = (linkrate / 8 / 53);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3458) printk("%s: Linkrate on ATM line : %u bit/s, %u cell/s.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3459) card->name, linkrate, card->link_pcr);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3460)
44beac008631d (Robert P. J. Day 2007-07-16 18:35:07 -0700 3461) #ifdef ATM_IDT77252_SEND_IDLE
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3462) card->utopia_pcr = card->link_pcr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3463) #else
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3464) card->utopia_pcr = (160000000 / 8 / 54);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3465) #endif
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3466)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3467) rsvdcr = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3468) if (card->utopia_pcr > card->link_pcr)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3469) rsvdcr = card->utopia_pcr - card->link_pcr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3470)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3471) tmpl = (unsigned long) rsvdcr * ((unsigned long) card->tst_size - 2);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3472) modl = tmpl % (unsigned long)card->utopia_pcr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3473) tst_entries = (int) (tmpl / (unsigned long)card->utopia_pcr);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3474) if (modl)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3475) tst_entries++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3476) card->tst_free -= tst_entries;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3477) fill_tst(card, NULL, tst_entries, TSTE_OPC_NULL);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3478)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3479) #ifdef HAVE_EEPROM
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3480) idt77252_eeprom_init(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3481) printk("%s: EEPROM: %02x:", card->name,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3482) idt77252_eeprom_read_status(card));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3483)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3484) for (i = 0; i < 0x80; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3485) printk(" %02x",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3486) idt77252_eeprom_read_byte(card, i)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3487) );
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3488) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3489) printk("\n");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3490) #endif /* HAVE_EEPROM */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3491)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3492) /*
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3493) * XXX: <hack>
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3494) */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3495) sprintf(tname, "eth%d", card->index);
881d966b48b03 (Eric W. Biederman 2007-09-17 11:56:21 -0700 3496) tmp = dev_get_by_name(&init_net, tname); /* jhs: was "tmp = dev_get(tname);" */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3497) if (tmp) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3498) memcpy(card->atmdev->esi, tmp->dev_addr, 6);
b5de4a22f157c (Ying Xue 2013-11-19 18:09:27 +0800 3499) dev_put(tmp);
aaa09ee7287d3 (hartleys 2010-01-05 06:24:23 +0000 3500) printk("%s: ESI %pM\n", card->name, card->atmdev->esi);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3501) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3502) /*
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3503) * XXX: </hack>
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3504) */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3505)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3506) /* Set Maximum Deficit Count for now. */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3507) writel(0xffff, SAR_REG_MDFCT);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3508)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3509) set_bit(IDT77252_BIT_INIT, &card->flags);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3510)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3511) XPRINTK("%s: IDT77252 ABR SAR initialization complete.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3512) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3513) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3514)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3515)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3516) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3517) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3518) /* Probing of IDT77252 ABR SAR */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3519) /* */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3520) /*****************************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3521)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3522)
6c44512d06d3f (Greg Kroah-Hartman 2012-12-21 13:25:04 -0800 3523) static int idt77252_preset(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3524) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3525) u16 pci_command;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3526)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3527) /*****************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3528) /* P C I C O N F I G U R A T I O N */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3529) /*****************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3530)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3531) XPRINTK("%s: Enable PCI master and memory access for SAR.\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3532) card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3533) if (pci_read_config_word(card->pcidev, PCI_COMMAND, &pci_command)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3534) printk("%s: can't read PCI_COMMAND.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3535) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3536) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3537) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3538) if (!(pci_command & PCI_COMMAND_IO)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3539) printk("%s: PCI_COMMAND: %04x (???)\n",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3540) card->name, pci_command);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3541) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3542) return (-1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3543) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3544) pci_command |= (PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3545) if (pci_write_config_word(card->pcidev, PCI_COMMAND, pci_command)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3546) printk("%s: can't write PCI_COMMAND.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3547) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3548) return -1;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3549) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3550) /*****************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3551) /* G E N E R I C R E S E T */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3552) /*****************************************************************/
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3553)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3554) /* Software reset */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3555) writel(SAR_CFG_SWRST, SAR_REG_CFG);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3556) mdelay(1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3557) writel(0, SAR_REG_CFG);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3558)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3559) IPRINTK("%s: Software resetted.\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3560) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3561) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3562)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3563)
6c44512d06d3f (Greg Kroah-Hartman 2012-12-21 13:25:04 -0800 3564) static unsigned long probe_sram(struct idt77252_dev *card)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3565) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3566) u32 data, addr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3567)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3568) writel(0, SAR_REG_DR0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3569) writel(SAR_CMD_WRITE_SRAM | (0 << 2), SAR_REG_CMD);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3570)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3571) for (addr = 0x4000; addr < 0x80000; addr += 0x4000) {
3c6b377321678 (Randy Dunlap 2006-07-03 19:48:25 -0700 3572) writel(ATM_POISON, SAR_REG_DR0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3573) writel(SAR_CMD_WRITE_SRAM | (addr << 2), SAR_REG_CMD);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3574)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3575) writel(SAR_CMD_READ_SRAM | (0 << 2), SAR_REG_CMD);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3576) data = readl(SAR_REG_DR0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3577)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3578) if (data != 0)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3579) break;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3580) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3581)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3582) return addr * sizeof(u32);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3583) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3584)
6c44512d06d3f (Greg Kroah-Hartman 2012-12-21 13:25:04 -0800 3585) static int idt77252_init_one(struct pci_dev *pcidev,
6c44512d06d3f (Greg Kroah-Hartman 2012-12-21 13:25:04 -0800 3586) const struct pci_device_id *id)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3587) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3588) static struct idt77252_dev **last = &idt77252_chain;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3589) static int index = 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3590)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3591) unsigned long membase, srambase;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3592) struct idt77252_dev *card;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3593) struct atm_dev *dev;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3594) int i, err;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3595)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3596)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3597) if ((err = pci_enable_device(pcidev))) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3598) printk("idt77252: can't enable PCI device at %s\n", pci_name(pcidev));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3599) return err;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3600) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3601)
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 3602) if ((err = dma_set_mask_and_coherent(&pcidev->dev, DMA_BIT_MASK(32)))) {
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 3603) printk("idt77252: can't enable DMA for PCI device at %s\n", pci_name(pcidev));
8df66af5c1e5f (Dan Carpenter 2020-12-19 14:01:44 +0300 3604) goto err_out_disable_pdev;
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 3605) }
ede58ef28e105 (chas williams - CONTRACTOR 2015-01-16 08:57:21 -0500 3606)
0c1cca1d8e0d5 (Om Narasimhan 2006-10-03 16:27:18 -0700 3607) card = kzalloc(sizeof(struct idt77252_dev), GFP_KERNEL);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3608) if (!card) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3609) printk("idt77252-%d: can't allocate private data\n", index);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3610) err = -ENOMEM;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3611) goto err_out_disable_pdev;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3612) }
44c10138fd4bb (Auke Kok 2007-06-08 15:46:36 -0700 3613) card->revision = pcidev->revision;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3614) card->index = index;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3615) card->pcidev = pcidev;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3616) sprintf(card->name, "idt77252-%d", card->index);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3617)
c4028958b6eca (David Howells 2006-11-22 14:57:56 +0000 3618) INIT_WORK(&card->tqueue, idt77252_softint);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3619)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3620) membase = pci_resource_start(pcidev, 1);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3621) srambase = pci_resource_start(pcidev, 2);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3622)
7e7a2d07b0faf (Matthias Kaehlcke 2007-05-23 14:45:45 -0700 3623) mutex_init(&card->mutex);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3624) spin_lock_init(&card->cmd_lock);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3625) spin_lock_init(&card->tst_lock);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3626)
e99e88a9d2b06 (Kees Cook 2017-10-16 14:43:17 -0700 3627) timer_setup(&card->tst_timer, tst_timer, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3628)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3629) /* Do the I/O remapping... */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3630) card->membase = ioremap(membase, 1024);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3631) if (!card->membase) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3632) printk("%s: can't ioremap() membase\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3633) err = -EIO;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3634) goto err_out_free_card;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3635) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3636)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3637) if (idt77252_preset(card)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3638) printk("%s: preset failed\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3639) err = -EIO;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3640) goto err_out_iounmap;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3641) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3642)
d9ca676bcb26e (Dan Williams 2010-12-08 19:40:47 +0000 3643) dev = atm_dev_register("idt77252", &pcidev->dev, &idt77252_ops, -1,
d9ca676bcb26e (Dan Williams 2010-12-08 19:40:47 +0000 3644) NULL);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3645) if (!dev) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3646) printk("%s: can't register atm device\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3647) err = -EIO;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3648) goto err_out_iounmap;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3649) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3650) dev->dev_data = card;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3651) card->atmdev = dev;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3652)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3653) #ifdef CONFIG_ATM_IDT77252_USE_SUNI
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3654) suni_init(dev);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3655) if (!dev->phy) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3656) printk("%s: can't init SUNI\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3657) err = -EIO;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3658) goto err_out_deinit_card;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3659) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3660) #endif /* CONFIG_ATM_IDT77252_USE_SUNI */
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3661)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3662) card->sramsize = probe_sram(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3663)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3664) for (i = 0; i < 4; i++) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3665) card->fbq[i] = ioremap(srambase | 0x200000 | (i << 18), 4);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3666) if (!card->fbq[i]) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3667) printk("%s: can't ioremap() FBQ%d\n", card->name, i);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3668) err = -EIO;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3669) goto err_out_deinit_card;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3670) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3671) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3672)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3673) printk("%s: ABR SAR (Rev %c): MEM %08lx SRAM %08lx [%u KB]\n",
44c10138fd4bb (Auke Kok 2007-06-08 15:46:36 -0700 3674) card->name, ((card->revision > 1) && (card->revision < 25)) ?
44c10138fd4bb (Auke Kok 2007-06-08 15:46:36 -0700 3675) 'A' + card->revision - 1 : '?', membase, srambase,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3676) card->sramsize / 1024);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3677)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3678) if (init_card(dev)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3679) printk("%s: init_card failed\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3680) err = -EIO;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3681) goto err_out_deinit_card;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3682) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3683)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3684) dev->ci_range.vpi_bits = card->vpibits;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3685) dev->ci_range.vci_bits = card->vcibits;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3686) dev->link_rate = card->link_pcr;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3687)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3688) if (dev->phy->start)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3689) dev->phy->start(dev);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3690)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3691) if (idt77252_dev_open(card)) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3692) printk("%s: dev_open failed\n", card->name);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3693) err = -EIO;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3694) goto err_out_stop;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3695) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3696)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3697) *last = card;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3698) last = &card->next;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3699) index++;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3700)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3701) return 0;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3702)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3703) err_out_stop:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3704) if (dev->phy->stop)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3705) dev->phy->stop(dev);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3706)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3707) err_out_deinit_card:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3708) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3709)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3710) err_out_iounmap:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3711) iounmap(card->membase);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3712)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3713) err_out_free_card:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3714) kfree(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3715)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3716) err_out_disable_pdev:
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3717) pci_disable_device(pcidev);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3718) return err;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3719) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3720)
97ae5c2aa4405 (Arvind Yadav 2017-07-16 15:02:40 +0530 3721) static const struct pci_device_id idt77252_pci_tbl[] =
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3722) {
e80d3f08e2ff0 (Peter Huewe 2010-07-15 08:45:32 +0000 3723) { PCI_VDEVICE(IDT, PCI_DEVICE_ID_IDT_IDT77252), 0 },
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3724) { 0, }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3725) };
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3726)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3727) MODULE_DEVICE_TABLE(pci, idt77252_pci_tbl);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3728)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3729) static struct pci_driver idt77252_driver = {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3730) .name = "idt77252",
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3731) .id_table = idt77252_pci_tbl,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3732) .probe = idt77252_init_one,
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3733) };
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3734)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3735) static int __init idt77252_init(void)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3736) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3737) struct sk_buff *skb;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3738)
5a346a10c0b11 (Harvey Harrison 2008-03-05 18:38:07 -0800 3739) printk("%s: at %p\n", __func__, idt77252_init);
d0a0bbe7b0a18 (Tong Zhang 2021-02-14 18:43:08 -0500 3740) BUILD_BUG_ON(sizeof(skb->cb) < sizeof(struct idt77252_skb_prv) + sizeof(struct atm_skb_data));
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3741) return pci_register_driver(&idt77252_driver);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3742) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3743)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3744) static void __exit idt77252_exit(void)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3745) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3746) struct idt77252_dev *card;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3747) struct atm_dev *dev;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3748)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3749) pci_unregister_driver(&idt77252_driver);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3750)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3751) while (idt77252_chain) {
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3752) card = idt77252_chain;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3753) dev = card->atmdev;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3754) idt77252_chain = card->next;
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3755)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3756) if (dev->phy->stop)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3757) dev->phy->stop(dev);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3758) deinit_card(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3759) pci_disable_device(card->pcidev);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3760) kfree(card);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3761) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3762)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3763) DIPRINTK("idt77252: finished cleanup-module().\n");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3764) }
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3765)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3766) module_init(idt77252_init);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3767) module_exit(idt77252_exit);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3768)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3769) MODULE_LICENSE("GPL");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3770)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3771) module_param(vpibits, uint, 0);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3772) MODULE_PARM_DESC(vpibits, "number of VPI bits supported (0, 1, or 2)");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3773) #ifdef CONFIG_ATM_IDT77252_DEBUG
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3774) module_param(debug, ulong, 0644);
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3775) MODULE_PARM_DESC(debug, "debug bitmap, see drivers/atm/idt77252.h");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3776) #endif
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3777)
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3778) MODULE_AUTHOR("Eddie C. Dost <ecd@atecom.com>");
^1da177e4c3f4 (Linus Torvalds 2005-04-16 15:20:36 -0700 3779) MODULE_DESCRIPTION("IDT77252 ABR SAR Driver");
VisionFive2 Linux kernel
StarFive Tech Linux Kernel for VisionFive (JH7110) boards (mirror)
More than 9999 Commits
33 Branches
57 Tags