^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) * Copyright 2008 Cisco Systems, Inc. All rights reserved.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright 2007 Nuova Systems, Inc. All rights reserved.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * This program is free software; you may redistribute it and/or modify
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * it under the terms of the GNU General Public License as published by
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * the Free Software Foundation; version 2 of the License.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) * SOFTWARE.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <linux/pci.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #include <linux/if_ether.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #include "vnic_resource.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #include "vnic_devcmd.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #include "vnic_dev.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #include "vnic_stats.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #include "vnic_wq.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) struct devcmd2_controller {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) struct vnic_wq_ctrl *wq_ctrl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) struct vnic_dev_ring results_ring;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) struct vnic_wq wq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) struct vnic_devcmd2 *cmd_ring;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) struct devcmd2_result *result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) u16 next_result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) u16 result_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) int color;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) enum vnic_proxy_type {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) PROXY_NONE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) PROXY_BY_BDF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) PROXY_BY_INDEX,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) struct vnic_res {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) void __iomem *vaddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) unsigned int count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) struct vnic_dev {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) void *priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) struct pci_dev *pdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) struct vnic_res res[RES_TYPE_MAX];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) enum vnic_dev_intr_mode intr_mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) struct vnic_devcmd __iomem *devcmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) struct vnic_devcmd_notify *notify;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) struct vnic_devcmd_notify notify_copy;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) dma_addr_t notify_pa;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) u32 *linkstatus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) dma_addr_t linkstatus_pa;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) struct vnic_stats *stats;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) dma_addr_t stats_pa;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) struct vnic_devcmd_fw_info *fw_info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) dma_addr_t fw_info_pa;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) enum vnic_proxy_type proxy;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) u32 proxy_index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) u64 args[VNIC_DEVCMD_NARGS];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) struct devcmd2_controller *devcmd2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) int (*devcmd_rtn)(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) int wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) #define VNIC_MAX_RES_HDR_SIZE \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) (sizeof(struct vnic_resource_header) + \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) sizeof(struct vnic_resource) * RES_TYPE_MAX)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) #define VNIC_RES_STRIDE 128
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) void *vnic_dev_priv(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) return vdev->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) static int vnic_dev_discover_res(struct vnic_dev *vdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) struct vnic_dev_bar *bar)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) struct vnic_resource_header __iomem *rh;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) struct vnic_resource __iomem *r;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) u8 type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) if (bar->len < VNIC_MAX_RES_HDR_SIZE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) printk(KERN_ERR "vNIC BAR0 res hdr length error\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) rh = bar->vaddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) if (!rh) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) printk(KERN_ERR "vNIC BAR0 res hdr not mem-mapped\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) if (ioread32(&rh->magic) != VNIC_RES_MAGIC ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) ioread32(&rh->version) != VNIC_RES_VERSION) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) printk(KERN_ERR "vNIC BAR0 res magic/version error "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) "exp (%lx/%lx) curr (%x/%x)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) VNIC_RES_MAGIC, VNIC_RES_VERSION,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) ioread32(&rh->magic), ioread32(&rh->version));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) r = (struct vnic_resource __iomem *)(rh + 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) while ((type = ioread8(&r->type)) != RES_TYPE_EOL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) u8 bar_num = ioread8(&r->bar);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) u32 bar_offset = ioread32(&r->bar_offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) u32 count = ioread32(&r->count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) u32 len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) r++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) if (bar_num != 0) /* only mapping in BAR0 resources */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) switch (type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) case RES_TYPE_WQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) case RES_TYPE_RQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) case RES_TYPE_CQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) case RES_TYPE_INTR_CTRL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) /* each count is stride bytes long */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) len = count * VNIC_RES_STRIDE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) if (len + bar_offset > bar->len) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) printk(KERN_ERR "vNIC BAR0 resource %d "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) "out-of-bounds, offset 0x%x + "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) "size 0x%x > bar len 0x%lx\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) type, bar_offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) bar->len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) case RES_TYPE_INTR_PBA_LEGACY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) case RES_TYPE_DEVCMD2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) case RES_TYPE_DEVCMD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) len = count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) vdev->res[type].count = count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) vdev->res[type].vaddr = (char __iomem *)bar->vaddr + bar_offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) unsigned int vnic_dev_get_res_count(struct vnic_dev *vdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) enum vnic_res_type type)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) return vdev->res[type].count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) void __iomem *vnic_dev_get_res(struct vnic_dev *vdev, enum vnic_res_type type,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) unsigned int index)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) if (!vdev->res[type].vaddr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) switch (type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) case RES_TYPE_WQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) case RES_TYPE_RQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) case RES_TYPE_CQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) case RES_TYPE_INTR_CTRL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) return (char __iomem *)vdev->res[type].vaddr +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) index * VNIC_RES_STRIDE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) return (char __iomem *)vdev->res[type].vaddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) unsigned int vnic_dev_desc_ring_size(struct vnic_dev_ring *ring,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) unsigned int desc_count,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) unsigned int desc_size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) /* The base address of the desc rings must be 512 byte aligned.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) * Descriptor count is aligned to groups of 32 descriptors. A
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) * count of 0 means the maximum 4096 descriptors. Descriptor
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) * size is aligned to 16 bytes.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) unsigned int count_align = 32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) unsigned int desc_align = 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) ring->base_align = 512;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) if (desc_count == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) desc_count = 4096;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) ring->desc_count = ALIGN(desc_count, count_align);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) ring->desc_size = ALIGN(desc_size, desc_align);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) ring->size = ring->desc_count * ring->desc_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) ring->size_unaligned = ring->size + ring->base_align;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) return ring->size_unaligned;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) void vnic_dev_clear_desc_ring(struct vnic_dev_ring *ring)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) memset(ring->descs, 0, ring->size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) int vnic_dev_alloc_desc_ring(struct vnic_dev *vdev, struct vnic_dev_ring *ring,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) unsigned int desc_count, unsigned int desc_size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) vnic_dev_desc_ring_size(ring, desc_count, desc_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) ring->descs_unaligned = dma_alloc_coherent(&vdev->pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) ring->size_unaligned,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) &ring->base_addr_unaligned, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) if (!ring->descs_unaligned) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) printk(KERN_ERR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) "Failed to allocate ring (size=%d), aborting\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) (int)ring->size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) ring->base_addr = ALIGN(ring->base_addr_unaligned,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) ring->base_align);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) ring->descs = (u8 *)ring->descs_unaligned +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) (ring->base_addr - ring->base_addr_unaligned);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) vnic_dev_clear_desc_ring(ring);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) ring->desc_avail = ring->desc_count - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) void vnic_dev_free_desc_ring(struct vnic_dev *vdev, struct vnic_dev_ring *ring)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) if (ring->descs) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) dma_free_coherent(&vdev->pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) ring->size_unaligned,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) ring->descs_unaligned,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) ring->base_addr_unaligned);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) ring->descs = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) static int vnic_dev_cmd1(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd, int wait)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) struct vnic_devcmd __iomem *devcmd = vdev->devcmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) int delay;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) u32 status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) static const int dev_cmd_err[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) /* convert from fw's version of error.h to host's version */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 0, /* ERR_SUCCESS */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) EINVAL, /* ERR_EINVAL */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) EFAULT, /* ERR_EFAULT */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) EPERM, /* ERR_EPERM */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) EBUSY, /* ERR_EBUSY */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) u64 *a0 = &vdev->args[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) u64 *a1 = &vdev->args[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) status = ioread32(&devcmd->status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) if (status & STAT_BUSY) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) printk(KERN_ERR "Busy devcmd %d\n", _CMD_N(cmd));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) if (_CMD_DIR(cmd) & _CMD_DIR_WRITE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) writeq(*a0, &devcmd->args[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) writeq(*a1, &devcmd->args[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) wmb();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) iowrite32(cmd, &devcmd->cmd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) if ((_CMD_FLAGS(cmd) & _CMD_FLAGS_NOWAIT))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) for (delay = 0; delay < wait; delay++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) udelay(100);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) status = ioread32(&devcmd->status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) if (!(status & STAT_BUSY)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) if (status & STAT_ERROR) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) err = dev_cmd_err[(int)readq(&devcmd->args[0])];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) printk(KERN_ERR "Error %d devcmd %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) err, _CMD_N(cmd));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) return -err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) if (_CMD_DIR(cmd) & _CMD_DIR_READ) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) rmb();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) *a0 = readq(&devcmd->args[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) *a1 = readq(&devcmd->args[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) printk(KERN_ERR "Timedout devcmd %d\n", _CMD_N(cmd));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) return -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) static int vnic_dev_cmd2(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) int wait)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) struct devcmd2_controller *dc2c = vdev->devcmd2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) struct devcmd2_result *result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) u8 color;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) unsigned int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) int delay;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) u32 fetch_index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) u32 posted;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) u32 new_posted;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) posted = ioread32(&dc2c->wq_ctrl->posted_index);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) fetch_index = ioread32(&dc2c->wq_ctrl->fetch_index);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) if (posted == 0xFFFFFFFF || fetch_index == 0xFFFFFFFF) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) /* Hardware surprise removal: return error */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) pr_err("%s: devcmd2 invalid posted or fetch index on cmd %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) pci_name(vdev->pdev), _CMD_N(cmd));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) pr_err("%s: fetch index: %u, posted index: %u\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) pci_name(vdev->pdev), fetch_index, posted);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) new_posted = (posted + 1) % DEVCMD2_RING_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) if (new_posted == fetch_index) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) pr_err("%s: devcmd2 wq full while issuing cmd %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) pci_name(vdev->pdev), _CMD_N(cmd));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) pr_err("%s: fetch index: %u, posted index: %u\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) pci_name(vdev->pdev), fetch_index, posted);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) dc2c->cmd_ring[posted].cmd = cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) dc2c->cmd_ring[posted].flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) if ((_CMD_FLAGS(cmd) & _CMD_FLAGS_NOWAIT))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) dc2c->cmd_ring[posted].flags |= DEVCMD2_FNORESULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) if (_CMD_DIR(cmd) & _CMD_DIR_WRITE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) for (i = 0; i < VNIC_DEVCMD_NARGS; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) dc2c->cmd_ring[posted].args[i] = vdev->args[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) /* Adding write memory barrier prevents compiler and/or CPU
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) * reordering, thus avoiding descriptor posting before
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) * descriptor is initialized. Otherwise, hardware can read
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) * stale descriptor fields.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) wmb();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) iowrite32(new_posted, &dc2c->wq_ctrl->posted_index);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) if (dc2c->cmd_ring[posted].flags & DEVCMD2_FNORESULT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) result = dc2c->result + dc2c->next_result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) color = dc2c->color;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) dc2c->next_result++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) if (dc2c->next_result == dc2c->result_size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) dc2c->next_result = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) dc2c->color = dc2c->color ? 0 : 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) for (delay = 0; delay < wait; delay++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) udelay(100);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) if (result->color == color) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) if (result->error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) err = -(int) result->error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) if (err != ERR_ECMDUNKNOWN ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) cmd != CMD_CAPABILITY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) pr_err("%s:Error %d devcmd %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) pci_name(vdev->pdev),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) err, _CMD_N(cmd));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) if (_CMD_DIR(cmd) & _CMD_DIR_READ) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) rmb(); /*prevent reorder while reding result*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) for (i = 0; i < VNIC_DEVCMD_NARGS; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) vdev->args[i] = result->results[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) pr_err("%s:Timed out devcmd %d\n", pci_name(vdev->pdev), _CMD_N(cmd));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) return -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) static int vnic_dev_init_devcmd1(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) vdev->devcmd = vnic_dev_get_res(vdev, RES_TYPE_DEVCMD, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) if (!vdev->devcmd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) vdev->devcmd_rtn = &vnic_dev_cmd1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) static int vnic_dev_init_devcmd2(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) unsigned int fetch_index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) if (vdev->devcmd2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) vdev->devcmd2 = kzalloc(sizeof(*vdev->devcmd2), GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) if (!vdev->devcmd2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) vdev->devcmd2->color = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) vdev->devcmd2->result_size = DEVCMD2_RING_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) err = vnic_wq_devcmd2_alloc(vdev, &vdev->devcmd2->wq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) DEVCMD2_RING_SIZE, DEVCMD2_DESC_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) goto err_free_devcmd2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) fetch_index = ioread32(&vdev->devcmd2->wq.ctrl->fetch_index);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) if (fetch_index == 0xFFFFFFFF) { /* check for hardware gone */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) pr_err("error in devcmd2 init");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) err = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) goto err_free_wq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) * Don't change fetch_index ever and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) * set posted_index same as fetch_index
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) * when setting up the WQ for devcmd2.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) vnic_wq_init_start(&vdev->devcmd2->wq, 0, fetch_index,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) fetch_index, 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) vnic_wq_enable(&vdev->devcmd2->wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) err = vnic_dev_alloc_desc_ring(vdev, &vdev->devcmd2->results_ring,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) DEVCMD2_RING_SIZE, DEVCMD2_DESC_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) goto err_disable_wq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) vdev->devcmd2->result =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) (struct devcmd2_result *) vdev->devcmd2->results_ring.descs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) vdev->devcmd2->cmd_ring =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) (struct vnic_devcmd2 *) vdev->devcmd2->wq.ring.descs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) vdev->devcmd2->wq_ctrl = vdev->devcmd2->wq.ctrl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) vdev->args[0] = (u64) vdev->devcmd2->results_ring.base_addr |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) VNIC_PADDR_TARGET;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) vdev->args[1] = DEVCMD2_RING_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) err = vnic_dev_cmd2(vdev, CMD_INITIALIZE_DEVCMD2, 1000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) goto err_free_desc_ring;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) vdev->devcmd_rtn = &vnic_dev_cmd2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) err_free_desc_ring:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) vnic_dev_free_desc_ring(vdev, &vdev->devcmd2->results_ring);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) err_disable_wq:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) vnic_wq_disable(&vdev->devcmd2->wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) err_free_wq:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) vnic_wq_free(&vdev->devcmd2->wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) err_free_devcmd2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) kfree(vdev->devcmd2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) vdev->devcmd2 = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) static void vnic_dev_deinit_devcmd2(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) vnic_dev_free_desc_ring(vdev, &vdev->devcmd2->results_ring);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) vnic_wq_disable(&vdev->devcmd2->wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) vnic_wq_free(&vdev->devcmd2->wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) kfree(vdev->devcmd2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) vdev->devcmd2 = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) vdev->devcmd_rtn = &vnic_dev_cmd1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) static int vnic_dev_cmd_no_proxy(struct vnic_dev *vdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) enum vnic_devcmd_cmd cmd, u64 *a0, u64 *a1, int wait)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) vdev->args[0] = *a0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) vdev->args[1] = *a1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) err = (*vdev->devcmd_rtn)(vdev, cmd, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) *a0 = vdev->args[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) *a1 = vdev->args[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) int vnic_dev_cmd(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) u64 *a0, u64 *a1, int wait)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) memset(vdev->args, 0, sizeof(vdev->args));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) switch (vdev->proxy) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) case PROXY_NONE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) return vnic_dev_cmd_no_proxy(vdev, cmd, a0, a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) int vnic_dev_fw_info(struct vnic_dev *vdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) struct vnic_devcmd_fw_info **fw_info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) u64 a0, a1 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) int err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) if (!vdev->fw_info) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) vdev->fw_info = dma_alloc_coherent(&vdev->pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) sizeof(struct vnic_devcmd_fw_info),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) &vdev->fw_info_pa, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) if (!vdev->fw_info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) a0 = vdev->fw_info_pa;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) /* only get fw_info once and cache it */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) err = vnic_dev_cmd(vdev, CMD_MCPU_FW_INFO, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) *fw_info = vdev->fw_info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) int vnic_dev_spec(struct vnic_dev *vdev, unsigned int offset, unsigned int size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) void *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) u64 a0, a1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) a0 = offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) a1 = size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) err = vnic_dev_cmd(vdev, CMD_DEV_SPEC, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) switch (size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) case 1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) *(u8 *)value = (u8)a0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) case 2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) *(u16 *)value = (u16)a0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) case 4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) *(u32 *)value = (u32)a0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) case 8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) *(u64 *)value = a0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) BUG();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) int vnic_dev_stats_clear(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) u64 a0 = 0, a1 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) return vnic_dev_cmd(vdev, CMD_STATS_CLEAR, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) int vnic_dev_stats_dump(struct vnic_dev *vdev, struct vnic_stats **stats)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) u64 a0, a1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) if (!vdev->stats) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) vdev->stats = dma_alloc_coherent(&vdev->pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) sizeof(struct vnic_stats), &vdev->stats_pa, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) if (!vdev->stats)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) *stats = vdev->stats;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) a0 = vdev->stats_pa;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) a1 = sizeof(struct vnic_stats);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) return vnic_dev_cmd(vdev, CMD_STATS_DUMP, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) int vnic_dev_close(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) u64 a0 = 0, a1 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) return vnic_dev_cmd(vdev, CMD_CLOSE, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) int vnic_dev_enable(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) u64 a0 = 0, a1 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) return vnic_dev_cmd(vdev, CMD_ENABLE, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) int vnic_dev_disable(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) u64 a0 = 0, a1 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) return vnic_dev_cmd(vdev, CMD_DISABLE, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) int vnic_dev_open(struct vnic_dev *vdev, int arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) u64 a0 = (u32)arg, a1 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) return vnic_dev_cmd(vdev, CMD_OPEN, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) int vnic_dev_open_done(struct vnic_dev *vdev, int *done)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) u64 a0 = 0, a1 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) *done = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) err = vnic_dev_cmd(vdev, CMD_OPEN_STATUS, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) *done = (a0 == 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) int vnic_dev_soft_reset(struct vnic_dev *vdev, int arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) u64 a0 = (u32)arg, a1 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) return vnic_dev_cmd(vdev, CMD_SOFT_RESET, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) int vnic_dev_soft_reset_done(struct vnic_dev *vdev, int *done)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) u64 a0 = 0, a1 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) *done = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) err = vnic_dev_cmd(vdev, CMD_SOFT_RESET_STATUS, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) *done = (a0 == 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) int vnic_dev_hang_notify(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) u64 a0 = 0, a1 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) return vnic_dev_cmd(vdev, CMD_HANG_NOTIFY, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) int vnic_dev_mac_addr(struct vnic_dev *vdev, u8 *mac_addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) u64 a[2] = {};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) int err, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) for (i = 0; i < ETH_ALEN; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) mac_addr[i] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) err = vnic_dev_cmd(vdev, CMD_MAC_ADDR, &a[0], &a[1], wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) for (i = 0; i < ETH_ALEN; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) mac_addr[i] = ((u8 *)&a)[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) void vnic_dev_packet_filter(struct vnic_dev *vdev, int directed, int multicast,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) int broadcast, int promisc, int allmulti)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) u64 a0, a1 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) a0 = (directed ? CMD_PFILTER_DIRECTED : 0) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) (multicast ? CMD_PFILTER_MULTICAST : 0) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) (broadcast ? CMD_PFILTER_BROADCAST : 0) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) (promisc ? CMD_PFILTER_PROMISCUOUS : 0) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) (allmulti ? CMD_PFILTER_ALL_MULTICAST : 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) err = vnic_dev_cmd(vdev, CMD_PACKET_FILTER, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) printk(KERN_ERR "Can't set packet filter\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) void vnic_dev_add_addr(struct vnic_dev *vdev, u8 *addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) u64 a[2] = {};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) for (i = 0; i < ETH_ALEN; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) ((u8 *)&a)[i] = addr[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) err = vnic_dev_cmd(vdev, CMD_ADDR_ADD, &a[0], &a[1], wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) pr_err("Can't add addr [%pM], %d\n", addr, err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) void vnic_dev_del_addr(struct vnic_dev *vdev, u8 *addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) u64 a[2] = {};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) for (i = 0; i < ETH_ALEN; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) ((u8 *)&a)[i] = addr[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760) err = vnic_dev_cmd(vdev, CMD_ADDR_DEL, &a[0], &a[1], wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) pr_err("Can't del addr [%pM], %d\n", addr, err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) int vnic_dev_notify_set(struct vnic_dev *vdev, u16 intr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) u64 a0, a1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) if (!vdev->notify) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) vdev->notify = dma_alloc_coherent(&vdev->pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772) sizeof(struct vnic_devcmd_notify),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) &vdev->notify_pa, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774) if (!vdev->notify)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778) a0 = vdev->notify_pa;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) a1 = ((u64)intr << 32) & 0x0000ffff00000000ULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780) a1 += sizeof(struct vnic_devcmd_notify);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) return vnic_dev_cmd(vdev, CMD_NOTIFY, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785) void vnic_dev_notify_unset(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787) u64 a0, a1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) a0 = 0; /* paddr = 0 to unset notify buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791) a1 = 0x0000ffff00000000ULL; /* intr num = -1 to unreg for intr */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792) a1 += sizeof(struct vnic_devcmd_notify);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) vnic_dev_cmd(vdev, CMD_NOTIFY, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) static int vnic_dev_notify_ready(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799) u32 *words;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) unsigned int nwords = sizeof(struct vnic_devcmd_notify) / 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801) unsigned int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 802) u32 csum;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 803)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 804) if (!vdev->notify)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 805) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 806)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 807) do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 808) csum = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 809) memcpy(&vdev->notify_copy, vdev->notify,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 810) sizeof(struct vnic_devcmd_notify));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 811) words = (u32 *)&vdev->notify_copy;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 812) for (i = 1; i < nwords; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 813) csum += words[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 814) } while (csum != words[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 815)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 816) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 817) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 818)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 819) int vnic_dev_init(struct vnic_dev *vdev, int arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 820) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 821) u64 a0 = (u32)arg, a1 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 822) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 823) return vnic_dev_cmd(vdev, CMD_INIT, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 824) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 825)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 826) u16 vnic_dev_set_default_vlan(struct vnic_dev *vdev, u16 new_default_vlan)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 827) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 828) u64 a0 = new_default_vlan, a1 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 829) int wait = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 830) int old_vlan = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 831)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 832) old_vlan = vnic_dev_cmd(vdev, CMD_SET_DEFAULT_VLAN, &a0, &a1, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 833) return (u16)old_vlan;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 834) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 835)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 836) int vnic_dev_link_status(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 837) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 838) if (vdev->linkstatus)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 839) return *vdev->linkstatus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 840)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 841) if (!vnic_dev_notify_ready(vdev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 842) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 843)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 844) return vdev->notify_copy.link_state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 845) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 846)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 847) u32 vnic_dev_port_speed(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 848) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 849) if (!vnic_dev_notify_ready(vdev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 850) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 851)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 852) return vdev->notify_copy.port_speed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 853) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 854)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 855) u32 vnic_dev_msg_lvl(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 856) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 857) if (!vnic_dev_notify_ready(vdev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 858) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 859)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 860) return vdev->notify_copy.msglvl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 861) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 862)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 863) u32 vnic_dev_mtu(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 864) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 865) if (!vnic_dev_notify_ready(vdev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 866) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 867)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 868) return vdev->notify_copy.mtu;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 869) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 870)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 871) u32 vnic_dev_link_down_cnt(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 872) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 873) if (!vnic_dev_notify_ready(vdev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 874) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 875)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 876) return vdev->notify_copy.link_down_cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 877) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 878)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 879) void vnic_dev_set_intr_mode(struct vnic_dev *vdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 880) enum vnic_dev_intr_mode intr_mode)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 881) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 882) vdev->intr_mode = intr_mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 883) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 884)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 885) enum vnic_dev_intr_mode vnic_dev_get_intr_mode(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 886) struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 887) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 888) return vdev->intr_mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 889) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 890)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 891) void vnic_dev_unregister(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 892) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 893) if (vdev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 894) if (vdev->notify)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 895) dma_free_coherent(&vdev->pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 896) sizeof(struct vnic_devcmd_notify),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 897) vdev->notify,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 898) vdev->notify_pa);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 899) if (vdev->linkstatus)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 900) dma_free_coherent(&vdev->pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 901) sizeof(u32),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 902) vdev->linkstatus,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 903) vdev->linkstatus_pa);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 904) if (vdev->stats)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 905) dma_free_coherent(&vdev->pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 906) sizeof(struct vnic_stats),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 907) vdev->stats, vdev->stats_pa);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 908) if (vdev->fw_info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 909) dma_free_coherent(&vdev->pdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 910) sizeof(struct vnic_devcmd_fw_info),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 911) vdev->fw_info, vdev->fw_info_pa);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 912) if (vdev->devcmd2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 913) vnic_dev_deinit_devcmd2(vdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 914) kfree(vdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 915) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 916) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 917)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 918) struct vnic_dev *vnic_dev_register(struct vnic_dev *vdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 919) void *priv, struct pci_dev *pdev, struct vnic_dev_bar *bar)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 920) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 921) if (!vdev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 922) vdev = kzalloc(sizeof(struct vnic_dev), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 923) if (!vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 924) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 925) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 926)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 927) vdev->priv = priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 928) vdev->pdev = pdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 929)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 930) if (vnic_dev_discover_res(vdev, bar))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 931) goto err_out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 932)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 933) return vdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 934)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 935) err_out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 936) vnic_dev_unregister(vdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 937) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 938) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 939)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 940) int vnic_dev_cmd_init(struct vnic_dev *vdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 941) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 942) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 943) void *p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 944)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 945) p = vnic_dev_get_res(vdev, RES_TYPE_DEVCMD2, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 946) if (p) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 947) pr_err("fnic: DEVCMD2 resource found!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 948) err = vnic_dev_init_devcmd2(vdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 949) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 950) pr_err("fnic: DEVCMD2 not found, fall back to Devcmd\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 951) err = vnic_dev_init_devcmd1(vdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 952) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 953)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 954) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 955) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags