9085fd0985
This patch introduces new fw devcmds for port profile handling. These new commands are similar to the current fw commands for port profile handling. The only difference being that the new commands split the existing port profile handling devcmds into multiple fw commands, giving the driver finer control over port profile operations. Signed-off-by: Roopa Prabhu <roprabhu@cisco.com> Signed-off-by: David Wang <dwang2@cisco.com> Signed-off-by: Christian Benvenuti <benve@cisco.com> Signed-off-by: David S. Miller <davem@davemloft.net>
943 lines
20 KiB
C
943 lines
20 KiB
C
/*
|
|
* Copyright 2008-2010 Cisco Systems, Inc. All rights reserved.
|
|
* Copyright 2007 Nuova Systems, Inc. All rights reserved.
|
|
*
|
|
* This program is free software; you may redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; version 2 of the License.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
|
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
|
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
|
|
* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
|
|
* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
|
|
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
|
* SOFTWARE.
|
|
*
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/types.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/if_ether.h>
|
|
|
|
#include "vnic_resource.h"
|
|
#include "vnic_devcmd.h"
|
|
#include "vnic_dev.h"
|
|
#include "vnic_stats.h"
|
|
|
|
enum vnic_proxy_type {
|
|
PROXY_NONE,
|
|
PROXY_BY_BDF,
|
|
};
|
|
|
|
struct vnic_res {
|
|
void __iomem *vaddr;
|
|
dma_addr_t bus_addr;
|
|
unsigned int count;
|
|
};
|
|
|
|
struct vnic_dev {
|
|
void *priv;
|
|
struct pci_dev *pdev;
|
|
struct vnic_res res[RES_TYPE_MAX];
|
|
enum vnic_dev_intr_mode intr_mode;
|
|
struct vnic_devcmd __iomem *devcmd;
|
|
struct vnic_devcmd_notify *notify;
|
|
struct vnic_devcmd_notify notify_copy;
|
|
dma_addr_t notify_pa;
|
|
u32 notify_sz;
|
|
dma_addr_t linkstatus_pa;
|
|
struct vnic_stats *stats;
|
|
dma_addr_t stats_pa;
|
|
struct vnic_devcmd_fw_info *fw_info;
|
|
dma_addr_t fw_info_pa;
|
|
enum vnic_proxy_type proxy;
|
|
u32 proxy_index;
|
|
u64 args[VNIC_DEVCMD_NARGS];
|
|
};
|
|
|
|
#define VNIC_MAX_RES_HDR_SIZE \
|
|
(sizeof(struct vnic_resource_header) + \
|
|
sizeof(struct vnic_resource) * RES_TYPE_MAX)
|
|
#define VNIC_RES_STRIDE 128
|
|
|
|
void *vnic_dev_priv(struct vnic_dev *vdev)
|
|
{
|
|
return vdev->priv;
|
|
}
|
|
|
|
static int vnic_dev_discover_res(struct vnic_dev *vdev,
|
|
struct vnic_dev_bar *bar, unsigned int num_bars)
|
|
{
|
|
struct vnic_resource_header __iomem *rh;
|
|
struct mgmt_barmap_hdr __iomem *mrh;
|
|
struct vnic_resource __iomem *r;
|
|
u8 type;
|
|
|
|
if (num_bars == 0)
|
|
return -EINVAL;
|
|
|
|
if (bar->len < VNIC_MAX_RES_HDR_SIZE) {
|
|
pr_err("vNIC BAR0 res hdr length error\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
rh = bar->vaddr;
|
|
mrh = bar->vaddr;
|
|
if (!rh) {
|
|
pr_err("vNIC BAR0 res hdr not mem-mapped\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Check for mgmt vnic in addition to normal vnic */
|
|
if ((ioread32(&rh->magic) != VNIC_RES_MAGIC) ||
|
|
(ioread32(&rh->version) != VNIC_RES_VERSION)) {
|
|
if ((ioread32(&mrh->magic) != MGMTVNIC_MAGIC) ||
|
|
(ioread32(&mrh->version) != MGMTVNIC_VERSION)) {
|
|
pr_err("vNIC BAR0 res magic/version error "
|
|
"exp (%lx/%lx) or (%lx/%lx), curr (%x/%x)\n",
|
|
VNIC_RES_MAGIC, VNIC_RES_VERSION,
|
|
MGMTVNIC_MAGIC, MGMTVNIC_VERSION,
|
|
ioread32(&rh->magic), ioread32(&rh->version));
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
if (ioread32(&mrh->magic) == MGMTVNIC_MAGIC)
|
|
r = (struct vnic_resource __iomem *)(mrh + 1);
|
|
else
|
|
r = (struct vnic_resource __iomem *)(rh + 1);
|
|
|
|
|
|
while ((type = ioread8(&r->type)) != RES_TYPE_EOL) {
|
|
|
|
u8 bar_num = ioread8(&r->bar);
|
|
u32 bar_offset = ioread32(&r->bar_offset);
|
|
u32 count = ioread32(&r->count);
|
|
u32 len;
|
|
|
|
r++;
|
|
|
|
if (bar_num >= num_bars)
|
|
continue;
|
|
|
|
if (!bar[bar_num].len || !bar[bar_num].vaddr)
|
|
continue;
|
|
|
|
switch (type) {
|
|
case RES_TYPE_WQ:
|
|
case RES_TYPE_RQ:
|
|
case RES_TYPE_CQ:
|
|
case RES_TYPE_INTR_CTRL:
|
|
/* each count is stride bytes long */
|
|
len = count * VNIC_RES_STRIDE;
|
|
if (len + bar_offset > bar[bar_num].len) {
|
|
pr_err("vNIC BAR0 resource %d "
|
|
"out-of-bounds, offset 0x%x + "
|
|
"size 0x%x > bar len 0x%lx\n",
|
|
type, bar_offset,
|
|
len,
|
|
bar[bar_num].len);
|
|
return -EINVAL;
|
|
}
|
|
break;
|
|
case RES_TYPE_INTR_PBA_LEGACY:
|
|
case RES_TYPE_DEVCMD:
|
|
len = count;
|
|
break;
|
|
default:
|
|
continue;
|
|
}
|
|
|
|
vdev->res[type].count = count;
|
|
vdev->res[type].vaddr = (char __iomem *)bar[bar_num].vaddr +
|
|
bar_offset;
|
|
vdev->res[type].bus_addr = bar[bar_num].bus_addr + bar_offset;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
unsigned int vnic_dev_get_res_count(struct vnic_dev *vdev,
|
|
enum vnic_res_type type)
|
|
{
|
|
return vdev->res[type].count;
|
|
}
|
|
|
|
void __iomem *vnic_dev_get_res(struct vnic_dev *vdev, enum vnic_res_type type,
|
|
unsigned int index)
|
|
{
|
|
if (!vdev->res[type].vaddr)
|
|
return NULL;
|
|
|
|
switch (type) {
|
|
case RES_TYPE_WQ:
|
|
case RES_TYPE_RQ:
|
|
case RES_TYPE_CQ:
|
|
case RES_TYPE_INTR_CTRL:
|
|
return (char __iomem *)vdev->res[type].vaddr +
|
|
index * VNIC_RES_STRIDE;
|
|
default:
|
|
return (char __iomem *)vdev->res[type].vaddr;
|
|
}
|
|
}
|
|
|
|
static unsigned int vnic_dev_desc_ring_size(struct vnic_dev_ring *ring,
|
|
unsigned int desc_count, unsigned int desc_size)
|
|
{
|
|
/* The base address of the desc rings must be 512 byte aligned.
|
|
* Descriptor count is aligned to groups of 32 descriptors. A
|
|
* count of 0 means the maximum 4096 descriptors. Descriptor
|
|
* size is aligned to 16 bytes.
|
|
*/
|
|
|
|
unsigned int count_align = 32;
|
|
unsigned int desc_align = 16;
|
|
|
|
ring->base_align = 512;
|
|
|
|
if (desc_count == 0)
|
|
desc_count = 4096;
|
|
|
|
ring->desc_count = ALIGN(desc_count, count_align);
|
|
|
|
ring->desc_size = ALIGN(desc_size, desc_align);
|
|
|
|
ring->size = ring->desc_count * ring->desc_size;
|
|
ring->size_unaligned = ring->size + ring->base_align;
|
|
|
|
return ring->size_unaligned;
|
|
}
|
|
|
|
void vnic_dev_clear_desc_ring(struct vnic_dev_ring *ring)
|
|
{
|
|
memset(ring->descs, 0, ring->size);
|
|
}
|
|
|
|
int vnic_dev_alloc_desc_ring(struct vnic_dev *vdev, struct vnic_dev_ring *ring,
|
|
unsigned int desc_count, unsigned int desc_size)
|
|
{
|
|
vnic_dev_desc_ring_size(ring, desc_count, desc_size);
|
|
|
|
ring->descs_unaligned = pci_alloc_consistent(vdev->pdev,
|
|
ring->size_unaligned,
|
|
&ring->base_addr_unaligned);
|
|
|
|
if (!ring->descs_unaligned) {
|
|
pr_err("Failed to allocate ring (size=%d), aborting\n",
|
|
(int)ring->size);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
ring->base_addr = ALIGN(ring->base_addr_unaligned,
|
|
ring->base_align);
|
|
ring->descs = (u8 *)ring->descs_unaligned +
|
|
(ring->base_addr - ring->base_addr_unaligned);
|
|
|
|
vnic_dev_clear_desc_ring(ring);
|
|
|
|
ring->desc_avail = ring->desc_count - 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
void vnic_dev_free_desc_ring(struct vnic_dev *vdev, struct vnic_dev_ring *ring)
|
|
{
|
|
if (ring->descs) {
|
|
pci_free_consistent(vdev->pdev,
|
|
ring->size_unaligned,
|
|
ring->descs_unaligned,
|
|
ring->base_addr_unaligned);
|
|
ring->descs = NULL;
|
|
}
|
|
}
|
|
|
|
static int _vnic_dev_cmd(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd,
|
|
int wait)
|
|
{
|
|
struct vnic_devcmd __iomem *devcmd = vdev->devcmd;
|
|
unsigned int i;
|
|
int delay;
|
|
u32 status;
|
|
int err;
|
|
|
|
status = ioread32(&devcmd->status);
|
|
if (status == 0xFFFFFFFF) {
|
|
/* PCI-e target device is gone */
|
|
return -ENODEV;
|
|
}
|
|
if (status & STAT_BUSY) {
|
|
pr_err("Busy devcmd %d\n", _CMD_N(cmd));
|
|
return -EBUSY;
|
|
}
|
|
|
|
if (_CMD_DIR(cmd) & _CMD_DIR_WRITE) {
|
|
for (i = 0; i < VNIC_DEVCMD_NARGS; i++)
|
|
writeq(vdev->args[i], &devcmd->args[i]);
|
|
wmb();
|
|
}
|
|
|
|
iowrite32(cmd, &devcmd->cmd);
|
|
|
|
if ((_CMD_FLAGS(cmd) & _CMD_FLAGS_NOWAIT))
|
|
return 0;
|
|
|
|
for (delay = 0; delay < wait; delay++) {
|
|
|
|
udelay(100);
|
|
|
|
status = ioread32(&devcmd->status);
|
|
if (status == 0xFFFFFFFF) {
|
|
/* PCI-e target device is gone */
|
|
return -ENODEV;
|
|
}
|
|
|
|
if (!(status & STAT_BUSY)) {
|
|
|
|
if (status & STAT_ERROR) {
|
|
err = (int)readq(&devcmd->args[0]);
|
|
if (err != ERR_ECMDUNKNOWN ||
|
|
cmd != CMD_CAPABILITY)
|
|
pr_err("Error %d devcmd %d\n",
|
|
err, _CMD_N(cmd));
|
|
return err;
|
|
}
|
|
|
|
if (_CMD_DIR(cmd) & _CMD_DIR_READ) {
|
|
rmb();
|
|
for (i = 0; i < VNIC_DEVCMD_NARGS; i++)
|
|
vdev->args[i] = readq(&devcmd->args[i]);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
pr_err("Timedout devcmd %d\n", _CMD_N(cmd));
|
|
return -ETIMEDOUT;
|
|
}
|
|
|
|
static int vnic_dev_cmd_proxy_by_bdf(struct vnic_dev *vdev,
|
|
enum vnic_devcmd_cmd cmd, u64 *a0, u64 *a1, int wait)
|
|
{
|
|
u32 status;
|
|
int err;
|
|
|
|
memset(vdev->args, 0, sizeof(vdev->args));
|
|
|
|
vdev->args[0] = vdev->proxy_index; /* bdf */
|
|
vdev->args[1] = cmd;
|
|
vdev->args[2] = *a0;
|
|
vdev->args[3] = *a1;
|
|
|
|
err = _vnic_dev_cmd(vdev, CMD_PROXY_BY_BDF, wait);
|
|
if (err)
|
|
return err;
|
|
|
|
status = (u32)vdev->args[0];
|
|
if (status & STAT_ERROR) {
|
|
err = (int)vdev->args[1];
|
|
if (err != ERR_ECMDUNKNOWN ||
|
|
cmd != CMD_CAPABILITY)
|
|
pr_err("Error %d proxy devcmd %d\n", err, _CMD_N(cmd));
|
|
return err;
|
|
}
|
|
|
|
*a0 = vdev->args[1];
|
|
*a1 = vdev->args[2];
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int vnic_dev_cmd_no_proxy(struct vnic_dev *vdev,
|
|
enum vnic_devcmd_cmd cmd, u64 *a0, u64 *a1, int wait)
|
|
{
|
|
int err;
|
|
|
|
vdev->args[0] = *a0;
|
|
vdev->args[1] = *a1;
|
|
|
|
err = _vnic_dev_cmd(vdev, cmd, wait);
|
|
|
|
*a0 = vdev->args[0];
|
|
*a1 = vdev->args[1];
|
|
|
|
return err;
|
|
}
|
|
|
|
int vnic_dev_cmd(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd,
|
|
u64 *a0, u64 *a1, int wait)
|
|
{
|
|
memset(vdev->args, 0, sizeof(vdev->args));
|
|
|
|
switch (vdev->proxy) {
|
|
case PROXY_BY_BDF:
|
|
return vnic_dev_cmd_proxy_by_bdf(vdev, cmd, a0, a1, wait);
|
|
case PROXY_NONE:
|
|
default:
|
|
return vnic_dev_cmd_no_proxy(vdev, cmd, a0, a1, wait);
|
|
}
|
|
}
|
|
|
|
static int vnic_dev_capable(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd)
|
|
{
|
|
u64 a0 = (u32)cmd, a1 = 0;
|
|
int wait = 1000;
|
|
int err;
|
|
|
|
err = vnic_dev_cmd(vdev, CMD_CAPABILITY, &a0, &a1, wait);
|
|
|
|
return !(err || a0);
|
|
}
|
|
|
|
int vnic_dev_fw_info(struct vnic_dev *vdev,
|
|
struct vnic_devcmd_fw_info **fw_info)
|
|
{
|
|
u64 a0, a1 = 0;
|
|
int wait = 1000;
|
|
int err = 0;
|
|
|
|
if (!vdev->fw_info) {
|
|
vdev->fw_info = pci_alloc_consistent(vdev->pdev,
|
|
sizeof(struct vnic_devcmd_fw_info),
|
|
&vdev->fw_info_pa);
|
|
if (!vdev->fw_info)
|
|
return -ENOMEM;
|
|
|
|
memset(vdev->fw_info, 0, sizeof(struct vnic_devcmd_fw_info));
|
|
|
|
a0 = vdev->fw_info_pa;
|
|
a1 = sizeof(struct vnic_devcmd_fw_info);
|
|
|
|
/* only get fw_info once and cache it */
|
|
err = vnic_dev_cmd(vdev, CMD_MCPU_FW_INFO, &a0, &a1, wait);
|
|
if (err == ERR_ECMDUNKNOWN) {
|
|
err = vnic_dev_cmd(vdev, CMD_MCPU_FW_INFO_OLD,
|
|
&a0, &a1, wait);
|
|
}
|
|
}
|
|
|
|
*fw_info = vdev->fw_info;
|
|
|
|
return err;
|
|
}
|
|
|
|
int vnic_dev_spec(struct vnic_dev *vdev, unsigned int offset, unsigned int size,
|
|
void *value)
|
|
{
|
|
u64 a0, a1;
|
|
int wait = 1000;
|
|
int err;
|
|
|
|
a0 = offset;
|
|
a1 = size;
|
|
|
|
err = vnic_dev_cmd(vdev, CMD_DEV_SPEC, &a0, &a1, wait);
|
|
|
|
switch (size) {
|
|
case 1: *(u8 *)value = (u8)a0; break;
|
|
case 2: *(u16 *)value = (u16)a0; break;
|
|
case 4: *(u32 *)value = (u32)a0; break;
|
|
case 8: *(u64 *)value = a0; break;
|
|
default: BUG(); break;
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
int vnic_dev_stats_dump(struct vnic_dev *vdev, struct vnic_stats **stats)
|
|
{
|
|
u64 a0, a1;
|
|
int wait = 1000;
|
|
|
|
if (!vdev->stats) {
|
|
vdev->stats = pci_alloc_consistent(vdev->pdev,
|
|
sizeof(struct vnic_stats), &vdev->stats_pa);
|
|
if (!vdev->stats)
|
|
return -ENOMEM;
|
|
}
|
|
|
|
*stats = vdev->stats;
|
|
a0 = vdev->stats_pa;
|
|
a1 = sizeof(struct vnic_stats);
|
|
|
|
return vnic_dev_cmd(vdev, CMD_STATS_DUMP, &a0, &a1, wait);
|
|
}
|
|
|
|
int vnic_dev_close(struct vnic_dev *vdev)
|
|
{
|
|
u64 a0 = 0, a1 = 0;
|
|
int wait = 1000;
|
|
return vnic_dev_cmd(vdev, CMD_CLOSE, &a0, &a1, wait);
|
|
}
|
|
|
|
int vnic_dev_enable_wait(struct vnic_dev *vdev)
|
|
{
|
|
u64 a0 = 0, a1 = 0;
|
|
int wait = 1000;
|
|
int err;
|
|
|
|
err = vnic_dev_cmd(vdev, CMD_ENABLE_WAIT, &a0, &a1, wait);
|
|
if (err == ERR_ECMDUNKNOWN)
|
|
return vnic_dev_cmd(vdev, CMD_ENABLE, &a0, &a1, wait);
|
|
|
|
return err;
|
|
}
|
|
|
|
int vnic_dev_disable(struct vnic_dev *vdev)
|
|
{
|
|
u64 a0 = 0, a1 = 0;
|
|
int wait = 1000;
|
|
return vnic_dev_cmd(vdev, CMD_DISABLE, &a0, &a1, wait);
|
|
}
|
|
|
|
int vnic_dev_open(struct vnic_dev *vdev, int arg)
|
|
{
|
|
u64 a0 = (u32)arg, a1 = 0;
|
|
int wait = 1000;
|
|
return vnic_dev_cmd(vdev, CMD_OPEN, &a0, &a1, wait);
|
|
}
|
|
|
|
int vnic_dev_open_done(struct vnic_dev *vdev, int *done)
|
|
{
|
|
u64 a0 = 0, a1 = 0;
|
|
int wait = 1000;
|
|
int err;
|
|
|
|
*done = 0;
|
|
|
|
err = vnic_dev_cmd(vdev, CMD_OPEN_STATUS, &a0, &a1, wait);
|
|
if (err)
|
|
return err;
|
|
|
|
*done = (a0 == 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int vnic_dev_soft_reset(struct vnic_dev *vdev, int arg)
|
|
{
|
|
u64 a0 = (u32)arg, a1 = 0;
|
|
int wait = 1000;
|
|
return vnic_dev_cmd(vdev, CMD_SOFT_RESET, &a0, &a1, wait);
|
|
}
|
|
|
|
static int vnic_dev_soft_reset_done(struct vnic_dev *vdev, int *done)
|
|
{
|
|
u64 a0 = 0, a1 = 0;
|
|
int wait = 1000;
|
|
int err;
|
|
|
|
*done = 0;
|
|
|
|
err = vnic_dev_cmd(vdev, CMD_SOFT_RESET_STATUS, &a0, &a1, wait);
|
|
if (err)
|
|
return err;
|
|
|
|
*done = (a0 == 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int vnic_dev_hang_reset(struct vnic_dev *vdev, int arg)
|
|
{
|
|
u64 a0 = (u32)arg, a1 = 0;
|
|
int wait = 1000;
|
|
int err;
|
|
|
|
err = vnic_dev_cmd(vdev, CMD_HANG_RESET, &a0, &a1, wait);
|
|
if (err == ERR_ECMDUNKNOWN) {
|
|
err = vnic_dev_soft_reset(vdev, arg);
|
|
if (err)
|
|
return err;
|
|
|
|
return vnic_dev_init(vdev, 0);
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
int vnic_dev_hang_reset_done(struct vnic_dev *vdev, int *done)
|
|
{
|
|
u64 a0 = 0, a1 = 0;
|
|
int wait = 1000;
|
|
int err;
|
|
|
|
*done = 0;
|
|
|
|
err = vnic_dev_cmd(vdev, CMD_HANG_RESET_STATUS, &a0, &a1, wait);
|
|
if (err) {
|
|
if (err == ERR_ECMDUNKNOWN)
|
|
return vnic_dev_soft_reset_done(vdev, done);
|
|
return err;
|
|
}
|
|
|
|
*done = (a0 == 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int vnic_dev_hang_notify(struct vnic_dev *vdev)
|
|
{
|
|
u64 a0, a1;
|
|
int wait = 1000;
|
|
return vnic_dev_cmd(vdev, CMD_HANG_NOTIFY, &a0, &a1, wait);
|
|
}
|
|
|
|
int vnic_dev_mac_addr(struct vnic_dev *vdev, u8 *mac_addr)
|
|
{
|
|
u64 a0, a1;
|
|
int wait = 1000;
|
|
int err, i;
|
|
|
|
for (i = 0; i < ETH_ALEN; i++)
|
|
mac_addr[i] = 0;
|
|
|
|
err = vnic_dev_cmd(vdev, CMD_MAC_ADDR, &a0, &a1, wait);
|
|
if (err)
|
|
return err;
|
|
|
|
for (i = 0; i < ETH_ALEN; i++)
|
|
mac_addr[i] = ((u8 *)&a0)[i];
|
|
|
|
return 0;
|
|
}
|
|
|
|
int vnic_dev_packet_filter(struct vnic_dev *vdev, int directed, int multicast,
|
|
int broadcast, int promisc, int allmulti)
|
|
{
|
|
u64 a0, a1 = 0;
|
|
int wait = 1000;
|
|
int err;
|
|
|
|
a0 = (directed ? CMD_PFILTER_DIRECTED : 0) |
|
|
(multicast ? CMD_PFILTER_MULTICAST : 0) |
|
|
(broadcast ? CMD_PFILTER_BROADCAST : 0) |
|
|
(promisc ? CMD_PFILTER_PROMISCUOUS : 0) |
|
|
(allmulti ? CMD_PFILTER_ALL_MULTICAST : 0);
|
|
|
|
err = vnic_dev_cmd(vdev, CMD_PACKET_FILTER, &a0, &a1, wait);
|
|
if (err)
|
|
pr_err("Can't set packet filter\n");
|
|
|
|
return err;
|
|
}
|
|
|
|
int vnic_dev_add_addr(struct vnic_dev *vdev, u8 *addr)
|
|
{
|
|
u64 a0 = 0, a1 = 0;
|
|
int wait = 1000;
|
|
int err;
|
|
int i;
|
|
|
|
for (i = 0; i < ETH_ALEN; i++)
|
|
((u8 *)&a0)[i] = addr[i];
|
|
|
|
err = vnic_dev_cmd(vdev, CMD_ADDR_ADD, &a0, &a1, wait);
|
|
if (err)
|
|
pr_err("Can't add addr [%pM], %d\n", addr, err);
|
|
|
|
return err;
|
|
}
|
|
|
|
int vnic_dev_del_addr(struct vnic_dev *vdev, u8 *addr)
|
|
{
|
|
u64 a0 = 0, a1 = 0;
|
|
int wait = 1000;
|
|
int err;
|
|
int i;
|
|
|
|
for (i = 0; i < ETH_ALEN; i++)
|
|
((u8 *)&a0)[i] = addr[i];
|
|
|
|
err = vnic_dev_cmd(vdev, CMD_ADDR_DEL, &a0, &a1, wait);
|
|
if (err)
|
|
pr_err("Can't del addr [%pM], %d\n", addr, err);
|
|
|
|
return err;
|
|
}
|
|
|
|
int vnic_dev_set_ig_vlan_rewrite_mode(struct vnic_dev *vdev,
|
|
u8 ig_vlan_rewrite_mode)
|
|
{
|
|
u64 a0 = ig_vlan_rewrite_mode, a1 = 0;
|
|
int wait = 1000;
|
|
int err;
|
|
|
|
err = vnic_dev_cmd(vdev, CMD_IG_VLAN_REWRITE_MODE, &a0, &a1, wait);
|
|
if (err == ERR_ECMDUNKNOWN)
|
|
return 0;
|
|
|
|
return err;
|
|
}
|
|
|
|
static int vnic_dev_notify_setcmd(struct vnic_dev *vdev,
|
|
void *notify_addr, dma_addr_t notify_pa, u16 intr)
|
|
{
|
|
u64 a0, a1;
|
|
int wait = 1000;
|
|
int r;
|
|
|
|
memset(notify_addr, 0, sizeof(struct vnic_devcmd_notify));
|
|
vdev->notify = notify_addr;
|
|
vdev->notify_pa = notify_pa;
|
|
|
|
a0 = (u64)notify_pa;
|
|
a1 = ((u64)intr << 32) & 0x0000ffff00000000ULL;
|
|
a1 += sizeof(struct vnic_devcmd_notify);
|
|
|
|
r = vnic_dev_cmd(vdev, CMD_NOTIFY, &a0, &a1, wait);
|
|
vdev->notify_sz = (r == 0) ? (u32)a1 : 0;
|
|
return r;
|
|
}
|
|
|
|
int vnic_dev_notify_set(struct vnic_dev *vdev, u16 intr)
|
|
{
|
|
void *notify_addr;
|
|
dma_addr_t notify_pa;
|
|
|
|
if (vdev->notify || vdev->notify_pa) {
|
|
pr_err("notify block %p still allocated", vdev->notify);
|
|
return -EINVAL;
|
|
}
|
|
|
|
notify_addr = pci_alloc_consistent(vdev->pdev,
|
|
sizeof(struct vnic_devcmd_notify),
|
|
¬ify_pa);
|
|
if (!notify_addr)
|
|
return -ENOMEM;
|
|
|
|
return vnic_dev_notify_setcmd(vdev, notify_addr, notify_pa, intr);
|
|
}
|
|
|
|
static int vnic_dev_notify_unsetcmd(struct vnic_dev *vdev)
|
|
{
|
|
u64 a0, a1;
|
|
int wait = 1000;
|
|
int err;
|
|
|
|
a0 = 0; /* paddr = 0 to unset notify buffer */
|
|
a1 = 0x0000ffff00000000ULL; /* intr num = -1 to unreg for intr */
|
|
a1 += sizeof(struct vnic_devcmd_notify);
|
|
|
|
err = vnic_dev_cmd(vdev, CMD_NOTIFY, &a0, &a1, wait);
|
|
vdev->notify = NULL;
|
|
vdev->notify_pa = 0;
|
|
vdev->notify_sz = 0;
|
|
|
|
return err;
|
|
}
|
|
|
|
int vnic_dev_notify_unset(struct vnic_dev *vdev)
|
|
{
|
|
if (vdev->notify) {
|
|
pci_free_consistent(vdev->pdev,
|
|
sizeof(struct vnic_devcmd_notify),
|
|
vdev->notify,
|
|
vdev->notify_pa);
|
|
}
|
|
|
|
return vnic_dev_notify_unsetcmd(vdev);
|
|
}
|
|
|
|
static int vnic_dev_notify_ready(struct vnic_dev *vdev)
|
|
{
|
|
u32 *words;
|
|
unsigned int nwords = vdev->notify_sz / 4;
|
|
unsigned int i;
|
|
u32 csum;
|
|
|
|
if (!vdev->notify || !vdev->notify_sz)
|
|
return 0;
|
|
|
|
do {
|
|
csum = 0;
|
|
memcpy(&vdev->notify_copy, vdev->notify, vdev->notify_sz);
|
|
words = (u32 *)&vdev->notify_copy;
|
|
for (i = 1; i < nwords; i++)
|
|
csum += words[i];
|
|
} while (csum != words[0]);
|
|
|
|
return 1;
|
|
}
|
|
|
|
int vnic_dev_init(struct vnic_dev *vdev, int arg)
|
|
{
|
|
u64 a0 = (u32)arg, a1 = 0;
|
|
int wait = 1000;
|
|
int r = 0;
|
|
|
|
if (vnic_dev_capable(vdev, CMD_INIT))
|
|
r = vnic_dev_cmd(vdev, CMD_INIT, &a0, &a1, wait);
|
|
else {
|
|
vnic_dev_cmd(vdev, CMD_INIT_v1, &a0, &a1, wait);
|
|
if (a0 & CMD_INITF_DEFAULT_MAC) {
|
|
/* Emulate these for old CMD_INIT_v1 which
|
|
* didn't pass a0 so no CMD_INITF_*.
|
|
*/
|
|
vnic_dev_cmd(vdev, CMD_MAC_ADDR, &a0, &a1, wait);
|
|
vnic_dev_cmd(vdev, CMD_ADDR_ADD, &a0, &a1, wait);
|
|
}
|
|
}
|
|
return r;
|
|
}
|
|
|
|
int vnic_dev_deinit(struct vnic_dev *vdev)
|
|
{
|
|
u64 a0 = 0, a1 = 0;
|
|
int wait = 1000;
|
|
|
|
return vnic_dev_cmd(vdev, CMD_DEINIT, &a0, &a1, wait);
|
|
}
|
|
|
|
int vnic_dev_link_status(struct vnic_dev *vdev)
|
|
{
|
|
if (!vnic_dev_notify_ready(vdev))
|
|
return 0;
|
|
|
|
return vdev->notify_copy.link_state;
|
|
}
|
|
|
|
u32 vnic_dev_port_speed(struct vnic_dev *vdev)
|
|
{
|
|
if (!vnic_dev_notify_ready(vdev))
|
|
return 0;
|
|
|
|
return vdev->notify_copy.port_speed;
|
|
}
|
|
|
|
u32 vnic_dev_msg_lvl(struct vnic_dev *vdev)
|
|
{
|
|
if (!vnic_dev_notify_ready(vdev))
|
|
return 0;
|
|
|
|
return vdev->notify_copy.msglvl;
|
|
}
|
|
|
|
u32 vnic_dev_mtu(struct vnic_dev *vdev)
|
|
{
|
|
if (!vnic_dev_notify_ready(vdev))
|
|
return 0;
|
|
|
|
return vdev->notify_copy.mtu;
|
|
}
|
|
|
|
void vnic_dev_set_intr_mode(struct vnic_dev *vdev,
|
|
enum vnic_dev_intr_mode intr_mode)
|
|
{
|
|
vdev->intr_mode = intr_mode;
|
|
}
|
|
|
|
enum vnic_dev_intr_mode vnic_dev_get_intr_mode(
|
|
struct vnic_dev *vdev)
|
|
{
|
|
return vdev->intr_mode;
|
|
}
|
|
|
|
void vnic_dev_unregister(struct vnic_dev *vdev)
|
|
{
|
|
if (vdev) {
|
|
if (vdev->notify)
|
|
pci_free_consistent(vdev->pdev,
|
|
sizeof(struct vnic_devcmd_notify),
|
|
vdev->notify,
|
|
vdev->notify_pa);
|
|
if (vdev->stats)
|
|
pci_free_consistent(vdev->pdev,
|
|
sizeof(struct vnic_stats),
|
|
vdev->stats, vdev->stats_pa);
|
|
if (vdev->fw_info)
|
|
pci_free_consistent(vdev->pdev,
|
|
sizeof(struct vnic_devcmd_fw_info),
|
|
vdev->fw_info, vdev->fw_info_pa);
|
|
kfree(vdev);
|
|
}
|
|
}
|
|
|
|
struct vnic_dev *vnic_dev_register(struct vnic_dev *vdev,
|
|
void *priv, struct pci_dev *pdev, struct vnic_dev_bar *bar,
|
|
unsigned int num_bars)
|
|
{
|
|
if (!vdev) {
|
|
vdev = kzalloc(sizeof(struct vnic_dev), GFP_ATOMIC);
|
|
if (!vdev)
|
|
return NULL;
|
|
}
|
|
|
|
vdev->priv = priv;
|
|
vdev->pdev = pdev;
|
|
|
|
if (vnic_dev_discover_res(vdev, bar, num_bars))
|
|
goto err_out;
|
|
|
|
vdev->devcmd = vnic_dev_get_res(vdev, RES_TYPE_DEVCMD, 0);
|
|
if (!vdev->devcmd)
|
|
goto err_out;
|
|
|
|
return vdev;
|
|
|
|
err_out:
|
|
vnic_dev_unregister(vdev);
|
|
return NULL;
|
|
}
|
|
|
|
int vnic_dev_init_prov2(struct vnic_dev *vdev, u8 *buf, u32 len)
|
|
{
|
|
u64 a0, a1 = len;
|
|
int wait = 1000;
|
|
dma_addr_t prov_pa;
|
|
void *prov_buf;
|
|
int ret;
|
|
|
|
prov_buf = pci_alloc_consistent(vdev->pdev, len, &prov_pa);
|
|
if (!prov_buf)
|
|
return -ENOMEM;
|
|
|
|
memcpy(prov_buf, buf, len);
|
|
|
|
a0 = prov_pa;
|
|
|
|
ret = vnic_dev_cmd(vdev, CMD_INIT_PROV_INFO2, &a0, &a1, wait);
|
|
|
|
pci_free_consistent(vdev->pdev, len, prov_buf, prov_pa);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int vnic_dev_enable2(struct vnic_dev *vdev, int active)
|
|
{
|
|
u64 a0, a1 = 0;
|
|
int wait = 1000;
|
|
|
|
a0 = (active ? CMD_ENABLE2_ACTIVE : 0);
|
|
|
|
return vnic_dev_cmd(vdev, CMD_ENABLE2, &a0, &a1, wait);
|
|
}
|
|
|
|
static int vnic_dev_cmd_status(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd,
|
|
int *status)
|
|
{
|
|
u64 a0 = cmd, a1 = 0;
|
|
int wait = 1000;
|
|
int ret;
|
|
|
|
ret = vnic_dev_cmd(vdev, CMD_STATUS, &a0, &a1, wait);
|
|
if (!ret)
|
|
*status = (int)a0;
|
|
|
|
return ret;
|
|
}
|
|
|
|
int vnic_dev_enable2_done(struct vnic_dev *vdev, int *status)
|
|
{
|
|
return vnic_dev_cmd_status(vdev, CMD_ENABLE2, status);
|
|
}
|
|
|
|
int vnic_dev_deinit_done(struct vnic_dev *vdev, int *status)
|
|
{
|
|
return vnic_dev_cmd_status(vdev, CMD_DEINIT, status);
|
|
}
|