11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright (C) 2002 Intersil Americas Inc. 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright 2004 Jens Maurer <Jens.Maurer@gmx.net> 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This program is free software; you can redistribute it and/or modify 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * it under the terms of the GNU General Public License as published by 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the Free Software Foundation; either version 2 of the License 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This program is distributed in the hope that it will be useful, 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * but WITHOUT ANY WARRANTY; without even the implied warranty of 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * GNU General Public License for more details. 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * You should have received a copy of the GNU General Public License 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * along with this program; if not, write to the Free Software 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/netdevice.h> 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/pci.h> 23d43c36dc6b357fa1806800f18aa30123c747a6d1Alexey Dobriyan#include <linux/sched.h> 245a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/io.h> 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/if_arp.h> 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "prismcompat.h" 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "isl_38xx.h" 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "islpci_mgt.h" 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "isl_oid.h" /* additional types and defs for isl38xx fw */ 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "isl_ioctl.h" 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <net/iw_handler.h> 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/****************************************************************************** 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds Global variable definition section 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds******************************************************************************/ 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint pc_debug = VERBOSE; 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_param(pc_debug, int, 0); 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/****************************************************************************** 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds Driver general functions 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds******************************************************************************/ 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if VERBOSE > SHOW_ERROR_MESSAGES 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsdisplay_buffer(char *buffer, int length) 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pc_debug & SHOW_BUFFER_CONTENTS) == 0) 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (length > 0) { 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("[%02x]", *buffer & 255); 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds length--; 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buffer++; 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("\n"); 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/***************************************************************************** 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds Queue handling for management frames 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds******************************************************************************/ 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Helper function to create a PIMFOR management frame header. 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldspimfor_encode_header(int operation, u32 oid, u32 length, pimfor_header_t *h) 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds h->version = PIMFOR_VERSION; 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds h->operation = operation; 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds h->device_id = PIMFOR_DEV_ID_MHLI_MIB; 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds h->flags = 0; 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds h->oid = cpu_to_be32(oid); 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds h->length = cpu_to_be32(length); 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Helper function to analyze a PIMFOR management frame header. 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic pimfor_header_t * 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldspimfor_decode_header(void *data, int len) 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pimfor_header_t *h = data; 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while ((void *) h < data + len) { 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (h->flags & PIMFOR_FLAG_LITTLE_ENDIAN) { 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds le32_to_cpus(&h->oid); 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds le32_to_cpus(&h->length); 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds be32_to_cpus(&h->oid); 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds be32_to_cpus(&h->length); 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (h->oid != OID_INL_TUNNEL) 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return h; 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds h++; 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Fill the receive queue for management frames with fresh buffers. 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsislpci_mgmt_rx_fill(struct net_device *ndev) 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds islpci_private *priv = netdev_priv(ndev); 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds isl38xx_control_block *cb = /* volatile not needed */ 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (isl38xx_control_block *) priv->control_block; 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 curr = le32_to_cpu(cb->driver_curr_frag[ISL38XX_CB_RX_MGMTQ]); 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if VERBOSE > SHOW_ERROR_MESSAGES 1164a89852c3533c0190cbe6b04b8b5d7bf4f9beea9Frans Pop DEBUG(SHOW_FUNCTION_CALLS, "islpci_mgmt_rx_fill\n"); 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (curr - priv->index_mgmt_rx < ISL38XX_CB_MGMT_QSIZE) { 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 index = curr % ISL38XX_CB_MGMT_QSIZE; 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct islpci_membuf *buf = &priv->mgmt_rx[index]; 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds isl38xx_fragment *frag = &cb->rx_data_mgmt[index]; 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (buf->mem == NULL) { 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf->mem = kmalloc(MGMT_FRAME_SIZE, GFP_ATOMIC); 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!buf->mem) { 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "Error allocating management frame.\n"); 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf->size = MGMT_FRAME_SIZE; 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (buf->pci_addr == 0) { 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf->pci_addr = pci_map_single(priv->pdev, buf->mem, 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds MGMT_FRAME_SIZE, 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PCI_DMA_FROMDEVICE); 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!buf->pci_addr) { 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING 1393fa63c7d82ab9a12a5d0a299069f8df9f35aa011Jean Delvare "Failed to make memory DMA'able.\n"); 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* be safe: always reset control block information */ 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frag->size = cpu_to_le16(MGMT_FRAME_SIZE); 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frag->flags = 0; 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frag->address = cpu_to_le32(buf->pci_addr); 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr++; 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* The fragment address in the control block must have 1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * been written before announcing the frame buffer to 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * device */ 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wmb(); 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cb->driver_curr_frag[ISL38XX_CB_RX_MGMTQ] = cpu_to_le32(curr); 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Create and transmit a management frame using "operation" and "oid", 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * with arguments data/length. 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * We either return an error and free the frame, or we return 0 and 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * islpci_mgt_cleanup_transmit() frees the frame in the tx-done 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * interrupt. 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsislpci_mgt_transmit(struct net_device *ndev, int operation, unsigned long oid, 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void *data, int length) 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds islpci_private *priv = netdev_priv(ndev); 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds isl38xx_control_block *cb = 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (isl38xx_control_block *) priv->control_block; 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void *p; 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err = -EINVAL; 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags; 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds isl38xx_fragment *frag; 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct islpci_membuf buf; 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 curr_frag; 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int index; 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int frag_len = length + PIMFOR_HEADER_SIZE; 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if VERBOSE > SHOW_ERROR_MESSAGES 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(SHOW_FUNCTION_CALLS, "islpci_mgt_transmit\n"); 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (frag_len > MGMT_FRAME_SIZE) { 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_DEBUG "%s: mgmt frame too large %d\n", 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ndev->name, frag_len); 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto error; 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -ENOMEM; 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = buf.mem = kmalloc(frag_len, GFP_KERNEL); 194e404decb0fb017be80552adee894b35307b6c7b4Joe Perches if (!buf.mem) 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto error; 196e404decb0fb017be80552adee894b35307b6c7b4Joe Perches 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf.size = frag_len; 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* create the header directly in the fragment data area */ 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pimfor_encode_header(operation, oid, length, (pimfor_header_t *) p); 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p += PIMFOR_HEADER_SIZE; 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (data) 2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy(p, data, length); 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(p, 0, length); 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if VERBOSE > SHOW_ERROR_MESSAGES 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pimfor_header_t *h = buf.mem; 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(SHOW_PIMFOR_FRAMES, 2124a89852c3533c0190cbe6b04b8b5d7bf4f9beea9Frans Pop "PIMFOR: op %i, oid 0x%08lx, device %i, flags 0x%x length 0x%x\n", 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds h->operation, oid, h->device_id, h->flags, length); 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* display the buffer contents for debugging */ 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds display_buffer((char *) h, sizeof (pimfor_header_t)); 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds display_buffer(p, length); 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -ENOMEM; 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf.pci_addr = pci_map_single(priv->pdev, buf.mem, frag_len, 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PCI_DMA_TODEVICE); 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!buf.pci_addr) { 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING "%s: cannot map PCI memory for mgmt\n", 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ndev->name); 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto error_free; 2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Protect the control block modifications against interrupts. */ 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irqsave(&priv->slock, flags); 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr_frag = le32_to_cpu(cb->driver_curr_frag[ISL38XX_CB_TX_MGMTQ]); 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (curr_frag - priv->index_mgmt_tx >= ISL38XX_CB_MGMT_QSIZE) { 2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING "%s: mgmt tx queue is still full\n", 2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ndev->name); 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto error_unlock; 2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* commit the frame to the tx device queue */ 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds index = curr_frag % ISL38XX_CB_MGMT_QSIZE; 2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds priv->mgmt_tx[index] = buf; 2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frag = &cb->tx_data_mgmt[index]; 2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frag->size = cpu_to_le16(frag_len); 2441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frag->flags = 0; /* for any other than the last fragment, set to 1 */ 2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frag->address = cpu_to_le32(buf.pci_addr); 2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* The fragment address in the control block must have 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * been written before announcing the frame buffer to 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * device */ 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wmb(); 2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cb->driver_curr_frag[ISL38XX_CB_TX_MGMTQ] = cpu_to_le32(curr_frag + 1); 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irqrestore(&priv->slock, flags); 2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* trigger the device */ 2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds islpci_trigger(priv); 2561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds error_unlock: 2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irqrestore(&priv->slock, flags); 2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds error_free: 2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(buf.mem); 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds error: 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 2671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Receive a management frame from the device. 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This can be an arbitrary number of traps, and at most one response 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * frame for a previous request sent via islpci_mgt_transmit(). 2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint 2721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsislpci_mgt_receive(struct net_device *ndev) 2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds islpci_private *priv = netdev_priv(ndev); 2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds isl38xx_control_block *cb = 2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (isl38xx_control_block *) priv->control_block; 2771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 curr_frag; 2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if VERBOSE > SHOW_ERROR_MESSAGES 2804a89852c3533c0190cbe6b04b8b5d7bf4f9beea9Frans Pop DEBUG(SHOW_FUNCTION_CALLS, "islpci_mgt_receive\n"); 2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Only once per interrupt, determine fragment range to 2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * process. This avoids an endless loop (i.e. lockup) if 2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * frames come in faster than we can process them. */ 2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr_frag = le32_to_cpu(cb->device_curr_frag[ISL38XX_CB_RX_MGMTQ]); 2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds barrier(); 2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (; priv->index_mgmt_rx < curr_frag; priv->index_mgmt_rx++) { 2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pimfor_header_t *header; 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 index = priv->index_mgmt_rx % ISL38XX_CB_MGMT_QSIZE; 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct islpci_membuf *buf = &priv->mgmt_rx[index]; 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u16 frag_len; 2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int size; 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct islpci_mgmtframe *frame; 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* I have no idea (and no documentation) if flags != 0 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is possible. Drop the frame, reuse the buffer. */ 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (le16_to_cpu(cb->rx_data_mgmt[index].flags) != 0) { 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING "%s: unknown flags 0x%04x\n", 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ndev->name, 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds le16_to_cpu(cb->rx_data_mgmt[index].flags)); 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* The device only returns the size of the header(s) here. */ 3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frag_len = le16_to_cpu(cb->rx_data_mgmt[index].size); 3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 3101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * We appear to have no way to tell the device the 3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * size of a receive buffer. Thus, if this check 3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * triggers, we likely have kernel heap corruption. */ 3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (frag_len > MGMT_FRAME_SIZE) { 3141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "%s: Bogus packet size of %d (%#x).\n", 3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ndev->name, frag_len, frag_len); 3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frag_len = MGMT_FRAME_SIZE; 3181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Ensure the results of device DMA are visible to the CPU. */ 3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pci_dma_sync_single_for_cpu(priv->pdev, buf->pci_addr, 3221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf->size, PCI_DMA_FROMDEVICE); 3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Perform endianess conversion for PIMFOR header in-place. */ 3251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds header = pimfor_decode_header(buf->mem, frag_len); 3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!header) { 3271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING "%s: no PIMFOR header found\n", 3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ndev->name); 3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 3301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* The device ID from the PIMFOR packet received from 3331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the MVC is always 0. We forward a sensible device_id. 3341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Not that anyone upstream would care... */ 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds header->device_id = priv->ndev->ifindex; 3361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if VERBOSE > SHOW_ERROR_MESSAGES 3381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(SHOW_PIMFOR_FRAMES, 3394a89852c3533c0190cbe6b04b8b5d7bf4f9beea9Frans Pop "PIMFOR: op %i, oid 0x%08x, device %i, flags 0x%x length 0x%x\n", 3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds header->operation, header->oid, header->device_id, 3411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds header->flags, header->length); 3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* display the buffer contents for debugging */ 3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds display_buffer((char *) header, PIMFOR_HEADER_SIZE); 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds display_buffer((char *) header + PIMFOR_HEADER_SIZE, 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds header->length); 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* nobody sends these */ 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (header->flags & PIMFOR_FLAG_APPLIC_ORIGIN) { 3511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_DEBUG 3521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "%s: errant PIMFOR application frame\n", 3531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ndev->name); 3541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 3551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Determine frame size, skipping OID_INL_TUNNEL headers. */ 3581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = PIMFOR_HEADER_SIZE + header->length; 3591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frame = kmalloc(sizeof (struct islpci_mgmtframe) + size, 3601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds GFP_ATOMIC); 3611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!frame) { 3621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING 3631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "%s: Out of memory, cannot handle oid 0x%08x\n", 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ndev->name, header->oid); 3651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 3661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frame->ndev = ndev; 3681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy(&frame->buf, header, size); 3691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frame->header = (pimfor_header_t *) frame->buf; 3701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frame->data = frame->buf + PIMFOR_HEADER_SIZE; 3711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if VERBOSE > SHOW_ERROR_MESSAGES 3731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(SHOW_PIMFOR_FRAMES, 3741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "frame: header: %p, data: %p, size: %d\n", 3751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frame->header, frame->data, size); 3761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 3771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (header->operation == PIMFOR_OP_TRAP) { 3791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if VERBOSE > SHOW_ERROR_MESSAGES 3801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_DEBUG 3811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "TRAP: oid 0x%x, device %i, flags 0x%x length %i\n", 3821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds header->oid, header->device_id, header->flags, 3831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds header->length); 3841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 3851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Create work to handle trap out of interrupt 3871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * context. */ 388c4028958b6ecad064b1a6303a6a5906d4fe48d73David Howells INIT_WORK(&frame->ws, prism54_process_trap); 3891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds schedule_work(&frame->ws); 3901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 3921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Signal the one waiting process that a response 3931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * has been received. */ 3941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((frame = xchg(&priv->mgmt_received, frame)) != NULL) { 3951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING 3961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "%s: mgmt response not collected\n", 3971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ndev->name); 3981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(frame); 3991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if VERBOSE > SHOW_ERROR_MESSAGES 4011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(SHOW_TRACING, "Wake up Mgmt Queue\n"); 4021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 4031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&priv->mgmt_wqueue); 4041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 4091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 4121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Cleanup the transmit queue by freeing all frames handled by the device. 4131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 4141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid 4151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsislpci_mgt_cleanup_transmit(struct net_device *ndev) 4161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds islpci_private *priv = netdev_priv(ndev); 4181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds isl38xx_control_block *cb = /* volatile not needed */ 4191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (isl38xx_control_block *) priv->control_block; 4201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 curr_frag; 4211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if VERBOSE > SHOW_ERROR_MESSAGES 4231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEBUG(SHOW_FUNCTION_CALLS, "islpci_mgt_cleanup_transmit\n"); 4241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 4251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Only once per cleanup, determine fragment range to 4271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * process. This avoids an endless loop (i.e. lockup) if 4281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the device became confused, incrementing device_curr_frag 4291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * rapidly. */ 4301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds curr_frag = le32_to_cpu(cb->device_curr_frag[ISL38XX_CB_TX_MGMTQ]); 4311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds barrier(); 4321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (; priv->index_mgmt_tx < curr_frag; priv->index_mgmt_tx++) { 4341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int index = priv->index_mgmt_tx % ISL38XX_CB_MGMT_QSIZE; 4351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct islpci_membuf *buf = &priv->mgmt_tx[index]; 4361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pci_unmap_single(priv->pdev, buf->pci_addr, buf->size, 4371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PCI_DMA_TODEVICE); 4381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf->pci_addr = 0; 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(buf->mem); 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf->mem = NULL; 4411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf->size = 0; 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 4461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Perform one request-response transaction to the device. 4471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 4481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint 4491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsislpci_mgt_transaction(struct net_device *ndev, 4501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int operation, unsigned long oid, 4511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void *senddata, int sendlen, 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct islpci_mgmtframe **recvframe) 4531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds islpci_private *priv = netdev_priv(ndev); 4553173c8907ffb2c64456142da3df2bd0500bd59e0Nishanth Aravamudan const long wait_cycle_jiffies = msecs_to_jiffies(ISL38XX_WAIT_CYCLE * 10); 4561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds long timeout_left = ISL38XX_MAX_WAIT_CYCLES * wait_cycle_jiffies; 4571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 4581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DEFINE_WAIT(wait); 4591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *recvframe = NULL; 4611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4621b34fd390c340b0554dcda9552f82d77dff8ed23Matthias Kaehlcke if (mutex_lock_interruptible(&priv->mgmt_lock)) 4631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ERESTARTSYS; 4641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds prepare_to_wait(&priv->mgmt_wqueue, &wait, TASK_UNINTERRUPTIBLE); 4661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = islpci_mgt_transmit(ndev, operation, oid, senddata, sendlen); 4671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err) 4681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 4691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -ETIMEDOUT; 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (timeout_left > 0) { 4721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int timeleft; 4731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct islpci_mgmtframe *frame; 4741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4753173c8907ffb2c64456142da3df2bd0500bd59e0Nishanth Aravamudan timeleft = schedule_timeout_uninterruptible(wait_cycle_jiffies); 4761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frame = xchg(&priv->mgmt_received, NULL); 4771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (frame) { 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (frame->header->oid == oid) { 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *recvframe = frame; 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = 0; 4811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 4821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 4831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_DEBUG 4841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "%s: expecting oid 0x%x, received 0x%x.\n", 4851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ndev->name, (unsigned int) oid, 4861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frame->header->oid); 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(frame); 4881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frame = NULL; 4891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (timeleft == 0) { 4921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_DEBUG 4931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "%s: timeout waiting for mgmt response %lu, " 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "triggering device\n", 4951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ndev->name, timeout_left); 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds islpci_trigger(priv); 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds timeout_left += timeleft - wait_cycle_jiffies; 4991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING "%s: timeout waiting for mgmt response\n", 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ndev->name); 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 50393b2dd12049d1adb0d76fb918fcd4c1030445433Dmitry Torokhov /* TODO: we should reset the device here */ 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out: 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds finish_wait(&priv->mgmt_wqueue, &wait); 5061b34fd390c340b0554dcda9552f82d77dff8ed23Matthias Kaehlcke mutex_unlock(&priv->mgmt_lock); 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 510