The driver can be premature in detecting stalled firmware
when the heartbeat is not updated because the firmware can
occasionally take a long time (more than 2 seconds) to service
a request, and doesn't update the heartbeat during that time.
The firmware heartbeat is not necessarily a steady 1 second
periodic beat, but better described as something that should
progress at least once in every DECVMD_TIMEOUT period.
The single-threaded design in the FW means that if a devcmd
or adminq request launches a large internal job, it is stuck
waiting for that job to finish before it can get back to
updating the heartbeat. Since all requests are "guaranteed"
to finish within the DEVCMD_TIMEOUT period, the driver needs
to less aggressive in checking the heartbeat progress.
We change our current 2 second window to something bigger than
DEVCMD_TIMEOUT which should take care of most of the issue.
We stop checking for the heartbeat while waiting for a request,
as long as we're still watching for the FW status. Lastly,
we make sure our FW status is up to date before running a
devcmd request.
Once we do this, we need to not check the heartbeat on DEV
commands because it may be stalled while we're on the fw_down
path. Instead, we can rely on the is_fw_running check.
Fixes: b2b9a8d7ed
("ionic: avoid races in ionic_heartbeat_check")
Signed-off-by: Brett Creeley <brett@pensando.io>
Signed-off-by: Shannon Nelson <snelson@pensando.io>
Signed-off-by: David S. Miller <davem@davemloft.net>
701 lines
17 KiB
C
701 lines
17 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/* Copyright(c) 2017 - 2019 Pensando Systems, Inc */
|
|
|
|
#include <linux/printk.h>
|
|
#include <linux/dynamic_debug.h>
|
|
#include <linux/module.h>
|
|
#include <linux/netdevice.h>
|
|
#include <linux/utsname.h>
|
|
#include <generated/utsrelease.h>
|
|
#include <linux/ctype.h>
|
|
|
|
#include "ionic.h"
|
|
#include "ionic_bus.h"
|
|
#include "ionic_lif.h"
|
|
#include "ionic_debugfs.h"
|
|
|
|
MODULE_DESCRIPTION(IONIC_DRV_DESCRIPTION);
|
|
MODULE_AUTHOR("Pensando Systems, Inc");
|
|
MODULE_LICENSE("GPL");
|
|
|
|
static const char *ionic_error_to_str(enum ionic_status_code code)
|
|
{
|
|
switch (code) {
|
|
case IONIC_RC_SUCCESS:
|
|
return "IONIC_RC_SUCCESS";
|
|
case IONIC_RC_EVERSION:
|
|
return "IONIC_RC_EVERSION";
|
|
case IONIC_RC_EOPCODE:
|
|
return "IONIC_RC_EOPCODE";
|
|
case IONIC_RC_EIO:
|
|
return "IONIC_RC_EIO";
|
|
case IONIC_RC_EPERM:
|
|
return "IONIC_RC_EPERM";
|
|
case IONIC_RC_EQID:
|
|
return "IONIC_RC_EQID";
|
|
case IONIC_RC_EQTYPE:
|
|
return "IONIC_RC_EQTYPE";
|
|
case IONIC_RC_ENOENT:
|
|
return "IONIC_RC_ENOENT";
|
|
case IONIC_RC_EINTR:
|
|
return "IONIC_RC_EINTR";
|
|
case IONIC_RC_EAGAIN:
|
|
return "IONIC_RC_EAGAIN";
|
|
case IONIC_RC_ENOMEM:
|
|
return "IONIC_RC_ENOMEM";
|
|
case IONIC_RC_EFAULT:
|
|
return "IONIC_RC_EFAULT";
|
|
case IONIC_RC_EBUSY:
|
|
return "IONIC_RC_EBUSY";
|
|
case IONIC_RC_EEXIST:
|
|
return "IONIC_RC_EEXIST";
|
|
case IONIC_RC_EINVAL:
|
|
return "IONIC_RC_EINVAL";
|
|
case IONIC_RC_ENOSPC:
|
|
return "IONIC_RC_ENOSPC";
|
|
case IONIC_RC_ERANGE:
|
|
return "IONIC_RC_ERANGE";
|
|
case IONIC_RC_BAD_ADDR:
|
|
return "IONIC_RC_BAD_ADDR";
|
|
case IONIC_RC_DEV_CMD:
|
|
return "IONIC_RC_DEV_CMD";
|
|
case IONIC_RC_ENOSUPP:
|
|
return "IONIC_RC_ENOSUPP";
|
|
case IONIC_RC_ERROR:
|
|
return "IONIC_RC_ERROR";
|
|
case IONIC_RC_ERDMA:
|
|
return "IONIC_RC_ERDMA";
|
|
case IONIC_RC_EBAD_FW:
|
|
return "IONIC_RC_EBAD_FW";
|
|
default:
|
|
return "IONIC_RC_UNKNOWN";
|
|
}
|
|
}
|
|
|
|
static int ionic_error_to_errno(enum ionic_status_code code)
|
|
{
|
|
switch (code) {
|
|
case IONIC_RC_SUCCESS:
|
|
return 0;
|
|
case IONIC_RC_EVERSION:
|
|
case IONIC_RC_EQTYPE:
|
|
case IONIC_RC_EQID:
|
|
case IONIC_RC_EINVAL:
|
|
case IONIC_RC_ENOSUPP:
|
|
return -EINVAL;
|
|
case IONIC_RC_EPERM:
|
|
return -EPERM;
|
|
case IONIC_RC_ENOENT:
|
|
return -ENOENT;
|
|
case IONIC_RC_EAGAIN:
|
|
return -EAGAIN;
|
|
case IONIC_RC_ENOMEM:
|
|
return -ENOMEM;
|
|
case IONIC_RC_EFAULT:
|
|
return -EFAULT;
|
|
case IONIC_RC_EBUSY:
|
|
return -EBUSY;
|
|
case IONIC_RC_EEXIST:
|
|
return -EEXIST;
|
|
case IONIC_RC_ENOSPC:
|
|
return -ENOSPC;
|
|
case IONIC_RC_ERANGE:
|
|
return -ERANGE;
|
|
case IONIC_RC_BAD_ADDR:
|
|
return -EFAULT;
|
|
case IONIC_RC_EOPCODE:
|
|
case IONIC_RC_EINTR:
|
|
case IONIC_RC_DEV_CMD:
|
|
case IONIC_RC_ERROR:
|
|
case IONIC_RC_ERDMA:
|
|
case IONIC_RC_EIO:
|
|
default:
|
|
return -EIO;
|
|
}
|
|
}
|
|
|
|
static const char *ionic_opcode_to_str(enum ionic_cmd_opcode opcode)
|
|
{
|
|
switch (opcode) {
|
|
case IONIC_CMD_NOP:
|
|
return "IONIC_CMD_NOP";
|
|
case IONIC_CMD_INIT:
|
|
return "IONIC_CMD_INIT";
|
|
case IONIC_CMD_RESET:
|
|
return "IONIC_CMD_RESET";
|
|
case IONIC_CMD_IDENTIFY:
|
|
return "IONIC_CMD_IDENTIFY";
|
|
case IONIC_CMD_GETATTR:
|
|
return "IONIC_CMD_GETATTR";
|
|
case IONIC_CMD_SETATTR:
|
|
return "IONIC_CMD_SETATTR";
|
|
case IONIC_CMD_PORT_IDENTIFY:
|
|
return "IONIC_CMD_PORT_IDENTIFY";
|
|
case IONIC_CMD_PORT_INIT:
|
|
return "IONIC_CMD_PORT_INIT";
|
|
case IONIC_CMD_PORT_RESET:
|
|
return "IONIC_CMD_PORT_RESET";
|
|
case IONIC_CMD_PORT_GETATTR:
|
|
return "IONIC_CMD_PORT_GETATTR";
|
|
case IONIC_CMD_PORT_SETATTR:
|
|
return "IONIC_CMD_PORT_SETATTR";
|
|
case IONIC_CMD_LIF_INIT:
|
|
return "IONIC_CMD_LIF_INIT";
|
|
case IONIC_CMD_LIF_RESET:
|
|
return "IONIC_CMD_LIF_RESET";
|
|
case IONIC_CMD_LIF_IDENTIFY:
|
|
return "IONIC_CMD_LIF_IDENTIFY";
|
|
case IONIC_CMD_LIF_SETATTR:
|
|
return "IONIC_CMD_LIF_SETATTR";
|
|
case IONIC_CMD_LIF_GETATTR:
|
|
return "IONIC_CMD_LIF_GETATTR";
|
|
case IONIC_CMD_LIF_SETPHC:
|
|
return "IONIC_CMD_LIF_SETPHC";
|
|
case IONIC_CMD_RX_MODE_SET:
|
|
return "IONIC_CMD_RX_MODE_SET";
|
|
case IONIC_CMD_RX_FILTER_ADD:
|
|
return "IONIC_CMD_RX_FILTER_ADD";
|
|
case IONIC_CMD_RX_FILTER_DEL:
|
|
return "IONIC_CMD_RX_FILTER_DEL";
|
|
case IONIC_CMD_Q_IDENTIFY:
|
|
return "IONIC_CMD_Q_IDENTIFY";
|
|
case IONIC_CMD_Q_INIT:
|
|
return "IONIC_CMD_Q_INIT";
|
|
case IONIC_CMD_Q_CONTROL:
|
|
return "IONIC_CMD_Q_CONTROL";
|
|
case IONIC_CMD_RDMA_RESET_LIF:
|
|
return "IONIC_CMD_RDMA_RESET_LIF";
|
|
case IONIC_CMD_RDMA_CREATE_EQ:
|
|
return "IONIC_CMD_RDMA_CREATE_EQ";
|
|
case IONIC_CMD_RDMA_CREATE_CQ:
|
|
return "IONIC_CMD_RDMA_CREATE_CQ";
|
|
case IONIC_CMD_RDMA_CREATE_ADMINQ:
|
|
return "IONIC_CMD_RDMA_CREATE_ADMINQ";
|
|
case IONIC_CMD_FW_DOWNLOAD:
|
|
return "IONIC_CMD_FW_DOWNLOAD";
|
|
case IONIC_CMD_FW_CONTROL:
|
|
return "IONIC_CMD_FW_CONTROL";
|
|
case IONIC_CMD_FW_DOWNLOAD_V1:
|
|
return "IONIC_CMD_FW_DOWNLOAD_V1";
|
|
case IONIC_CMD_FW_CONTROL_V1:
|
|
return "IONIC_CMD_FW_CONTROL_V1";
|
|
case IONIC_CMD_VF_GETATTR:
|
|
return "IONIC_CMD_VF_GETATTR";
|
|
case IONIC_CMD_VF_SETATTR:
|
|
return "IONIC_CMD_VF_SETATTR";
|
|
default:
|
|
return "DEVCMD_UNKNOWN";
|
|
}
|
|
}
|
|
|
|
const char *ionic_vf_attr_to_str(enum ionic_vf_attr attr)
|
|
{
|
|
switch (attr) {
|
|
case IONIC_VF_ATTR_SPOOFCHK:
|
|
return "IONIC_VF_ATTR_SPOOFCHK";
|
|
case IONIC_VF_ATTR_TRUST:
|
|
return "IONIC_VF_ATTR_TRUST";
|
|
case IONIC_VF_ATTR_LINKSTATE:
|
|
return "IONIC_VF_ATTR_LINKSTATE";
|
|
case IONIC_VF_ATTR_MAC:
|
|
return "IONIC_VF_ATTR_MAC";
|
|
case IONIC_VF_ATTR_VLAN:
|
|
return "IONIC_VF_ATTR_VLAN";
|
|
case IONIC_VF_ATTR_RATE:
|
|
return "IONIC_VF_ATTR_RATE";
|
|
case IONIC_VF_ATTR_STATSADDR:
|
|
return "IONIC_VF_ATTR_STATSADDR";
|
|
default:
|
|
return "IONIC_VF_ATTR_UNKNOWN";
|
|
}
|
|
}
|
|
|
|
static void ionic_adminq_flush(struct ionic_lif *lif)
|
|
{
|
|
struct ionic_desc_info *desc_info;
|
|
unsigned long irqflags;
|
|
struct ionic_queue *q;
|
|
|
|
spin_lock_irqsave(&lif->adminq_lock, irqflags);
|
|
if (!lif->adminqcq) {
|
|
spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
|
|
return;
|
|
}
|
|
|
|
q = &lif->adminqcq->q;
|
|
|
|
while (q->tail_idx != q->head_idx) {
|
|
desc_info = &q->info[q->tail_idx];
|
|
memset(desc_info->desc, 0, sizeof(union ionic_adminq_cmd));
|
|
desc_info->cb = NULL;
|
|
desc_info->cb_arg = NULL;
|
|
q->tail_idx = (q->tail_idx + 1) & (q->num_descs - 1);
|
|
}
|
|
spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
|
|
}
|
|
|
|
void ionic_adminq_netdev_err_print(struct ionic_lif *lif, u8 opcode,
|
|
u8 status, int err)
|
|
{
|
|
const char *stat_str;
|
|
|
|
stat_str = (err == -ETIMEDOUT) ? "TIMEOUT" :
|
|
ionic_error_to_str(status);
|
|
|
|
netdev_err(lif->netdev, "%s (%d) failed: %s (%d)\n",
|
|
ionic_opcode_to_str(opcode), opcode, stat_str, err);
|
|
}
|
|
|
|
static int ionic_adminq_check_err(struct ionic_lif *lif,
|
|
struct ionic_admin_ctx *ctx,
|
|
const bool timeout,
|
|
const bool do_msg)
|
|
{
|
|
int err = 0;
|
|
|
|
if (ctx->comp.comp.status || timeout) {
|
|
err = timeout ? -ETIMEDOUT :
|
|
ionic_error_to_errno(ctx->comp.comp.status);
|
|
|
|
if (do_msg)
|
|
ionic_adminq_netdev_err_print(lif, ctx->cmd.cmd.opcode,
|
|
ctx->comp.comp.status, err);
|
|
|
|
if (timeout)
|
|
ionic_adminq_flush(lif);
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
static void ionic_adminq_cb(struct ionic_queue *q,
|
|
struct ionic_desc_info *desc_info,
|
|
struct ionic_cq_info *cq_info, void *cb_arg)
|
|
{
|
|
struct ionic_admin_ctx *ctx = cb_arg;
|
|
struct ionic_admin_comp *comp;
|
|
|
|
if (!ctx)
|
|
return;
|
|
|
|
comp = cq_info->cq_desc;
|
|
|
|
memcpy(&ctx->comp, comp, sizeof(*comp));
|
|
|
|
dev_dbg(q->dev, "comp admin queue command:\n");
|
|
dynamic_hex_dump("comp ", DUMP_PREFIX_OFFSET, 16, 1,
|
|
&ctx->comp, sizeof(ctx->comp), true);
|
|
|
|
complete_all(&ctx->work);
|
|
}
|
|
|
|
int ionic_adminq_post(struct ionic_lif *lif, struct ionic_admin_ctx *ctx)
|
|
{
|
|
struct ionic_desc_info *desc_info;
|
|
unsigned long irqflags;
|
|
struct ionic_queue *q;
|
|
int err = 0;
|
|
|
|
spin_lock_irqsave(&lif->adminq_lock, irqflags);
|
|
if (!lif->adminqcq) {
|
|
spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
|
|
return -EIO;
|
|
}
|
|
|
|
q = &lif->adminqcq->q;
|
|
|
|
if (!ionic_q_has_space(q, 1)) {
|
|
err = -ENOSPC;
|
|
goto err_out;
|
|
}
|
|
|
|
err = ionic_heartbeat_check(lif->ionic);
|
|
if (err)
|
|
goto err_out;
|
|
|
|
desc_info = &q->info[q->head_idx];
|
|
memcpy(desc_info->desc, &ctx->cmd, sizeof(ctx->cmd));
|
|
|
|
dev_dbg(&lif->netdev->dev, "post admin queue command:\n");
|
|
dynamic_hex_dump("cmd ", DUMP_PREFIX_OFFSET, 16, 1,
|
|
&ctx->cmd, sizeof(ctx->cmd), true);
|
|
|
|
ionic_q_post(q, true, ionic_adminq_cb, ctx);
|
|
|
|
err_out:
|
|
spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
|
|
|
|
return err;
|
|
}
|
|
|
|
int ionic_adminq_wait(struct ionic_lif *lif, struct ionic_admin_ctx *ctx,
|
|
const int err, const bool do_msg)
|
|
{
|
|
struct net_device *netdev = lif->netdev;
|
|
unsigned long time_limit;
|
|
unsigned long time_start;
|
|
unsigned long time_done;
|
|
unsigned long remaining;
|
|
const char *name;
|
|
|
|
name = ionic_opcode_to_str(ctx->cmd.cmd.opcode);
|
|
|
|
if (err) {
|
|
if (do_msg && !test_bit(IONIC_LIF_F_FW_RESET, lif->state))
|
|
netdev_err(netdev, "Posting of %s (%d) failed: %d\n",
|
|
name, ctx->cmd.cmd.opcode, err);
|
|
ctx->comp.comp.status = IONIC_RC_ERROR;
|
|
return err;
|
|
}
|
|
|
|
time_start = jiffies;
|
|
time_limit = time_start + HZ * (ulong)DEVCMD_TIMEOUT;
|
|
do {
|
|
remaining = wait_for_completion_timeout(&ctx->work,
|
|
IONIC_ADMINQ_TIME_SLICE);
|
|
|
|
/* check for done */
|
|
if (remaining)
|
|
break;
|
|
|
|
/* force a check of FW status and break out if FW reset */
|
|
(void)ionic_heartbeat_check(lif->ionic);
|
|
if ((test_bit(IONIC_LIF_F_FW_RESET, lif->state) &&
|
|
!lif->ionic->idev.fw_status_ready) ||
|
|
test_bit(IONIC_LIF_F_FW_STOPPING, lif->state)) {
|
|
if (do_msg)
|
|
netdev_warn(netdev, "%s (%d) interrupted, FW in reset\n",
|
|
name, ctx->cmd.cmd.opcode);
|
|
ctx->comp.comp.status = IONIC_RC_ERROR;
|
|
return -ENXIO;
|
|
}
|
|
|
|
} while (time_before(jiffies, time_limit));
|
|
time_done = jiffies;
|
|
|
|
dev_dbg(lif->ionic->dev, "%s: elapsed %d msecs\n",
|
|
__func__, jiffies_to_msecs(time_done - time_start));
|
|
|
|
return ionic_adminq_check_err(lif, ctx,
|
|
time_after_eq(time_done, time_limit),
|
|
do_msg);
|
|
}
|
|
|
|
int ionic_adminq_post_wait(struct ionic_lif *lif, struct ionic_admin_ctx *ctx)
|
|
{
|
|
int err;
|
|
|
|
err = ionic_adminq_post(lif, ctx);
|
|
|
|
return ionic_adminq_wait(lif, ctx, err, true);
|
|
}
|
|
|
|
int ionic_adminq_post_wait_nomsg(struct ionic_lif *lif, struct ionic_admin_ctx *ctx)
|
|
{
|
|
int err;
|
|
|
|
err = ionic_adminq_post(lif, ctx);
|
|
|
|
return ionic_adminq_wait(lif, ctx, err, false);
|
|
}
|
|
|
|
static void ionic_dev_cmd_clean(struct ionic *ionic)
|
|
{
|
|
struct ionic_dev *idev = &ionic->idev;
|
|
|
|
iowrite32(0, &idev->dev_cmd_regs->doorbell);
|
|
memset_io(&idev->dev_cmd_regs->cmd, 0, sizeof(idev->dev_cmd_regs->cmd));
|
|
}
|
|
|
|
void ionic_dev_cmd_dev_err_print(struct ionic *ionic, u8 opcode, u8 status,
|
|
int err)
|
|
{
|
|
const char *stat_str;
|
|
|
|
stat_str = (err == -ETIMEDOUT) ? "TIMEOUT" :
|
|
ionic_error_to_str(status);
|
|
|
|
dev_err(ionic->dev, "DEV_CMD %s (%d) error, %s (%d) failed\n",
|
|
ionic_opcode_to_str(opcode), opcode, stat_str, err);
|
|
}
|
|
|
|
static int __ionic_dev_cmd_wait(struct ionic *ionic, unsigned long max_seconds,
|
|
const bool do_msg)
|
|
{
|
|
struct ionic_dev *idev = &ionic->idev;
|
|
unsigned long start_time;
|
|
unsigned long max_wait;
|
|
unsigned long duration;
|
|
int done = 0;
|
|
bool fw_up;
|
|
int opcode;
|
|
int err;
|
|
|
|
/* Wait for dev cmd to complete, retrying if we get EAGAIN,
|
|
* but don't wait any longer than max_seconds.
|
|
*/
|
|
max_wait = jiffies + (max_seconds * HZ);
|
|
try_again:
|
|
opcode = readb(&idev->dev_cmd_regs->cmd.cmd.opcode);
|
|
start_time = jiffies;
|
|
for (fw_up = ionic_is_fw_running(idev);
|
|
!done && fw_up && time_before(jiffies, max_wait);
|
|
fw_up = ionic_is_fw_running(idev)) {
|
|
done = ionic_dev_cmd_done(idev);
|
|
if (done)
|
|
break;
|
|
usleep_range(100, 200);
|
|
}
|
|
duration = jiffies - start_time;
|
|
|
|
dev_dbg(ionic->dev, "DEVCMD %s (%d) done=%d took %ld secs (%ld jiffies)\n",
|
|
ionic_opcode_to_str(opcode), opcode,
|
|
done, duration / HZ, duration);
|
|
|
|
if (!done && !fw_up) {
|
|
ionic_dev_cmd_clean(ionic);
|
|
dev_warn(ionic->dev, "DEVCMD %s (%d) interrupted - FW is down\n",
|
|
ionic_opcode_to_str(opcode), opcode);
|
|
return -ENXIO;
|
|
}
|
|
|
|
if (!done && !time_before(jiffies, max_wait)) {
|
|
ionic_dev_cmd_clean(ionic);
|
|
dev_warn(ionic->dev, "DEVCMD %s (%d) timeout after %ld secs\n",
|
|
ionic_opcode_to_str(opcode), opcode, max_seconds);
|
|
return -ETIMEDOUT;
|
|
}
|
|
|
|
err = ionic_dev_cmd_status(&ionic->idev);
|
|
if (err) {
|
|
if (err == IONIC_RC_EAGAIN &&
|
|
time_before(jiffies, (max_wait - HZ))) {
|
|
dev_dbg(ionic->dev, "DEV_CMD %s (%d), %s (%d) retrying...\n",
|
|
ionic_opcode_to_str(opcode), opcode,
|
|
ionic_error_to_str(err), err);
|
|
|
|
msleep(1000);
|
|
iowrite32(0, &idev->dev_cmd_regs->done);
|
|
iowrite32(1, &idev->dev_cmd_regs->doorbell);
|
|
goto try_again;
|
|
}
|
|
|
|
if (!(opcode == IONIC_CMD_FW_CONTROL && err == IONIC_RC_EAGAIN))
|
|
if (do_msg)
|
|
ionic_dev_cmd_dev_err_print(ionic, opcode, err,
|
|
ionic_error_to_errno(err));
|
|
|
|
return ionic_error_to_errno(err);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int ionic_dev_cmd_wait(struct ionic *ionic, unsigned long max_seconds)
|
|
{
|
|
return __ionic_dev_cmd_wait(ionic, max_seconds, true);
|
|
}
|
|
|
|
int ionic_dev_cmd_wait_nomsg(struct ionic *ionic, unsigned long max_seconds)
|
|
{
|
|
return __ionic_dev_cmd_wait(ionic, max_seconds, false);
|
|
}
|
|
|
|
int ionic_setup(struct ionic *ionic)
|
|
{
|
|
int err;
|
|
|
|
err = ionic_dev_setup(ionic);
|
|
if (err)
|
|
return err;
|
|
ionic_reset(ionic);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int ionic_identify(struct ionic *ionic)
|
|
{
|
|
struct ionic_identity *ident = &ionic->ident;
|
|
struct ionic_dev *idev = &ionic->idev;
|
|
size_t sz;
|
|
int err;
|
|
|
|
memset(ident, 0, sizeof(*ident));
|
|
|
|
ident->drv.os_type = cpu_to_le32(IONIC_OS_TYPE_LINUX);
|
|
strncpy(ident->drv.driver_ver_str, UTS_RELEASE,
|
|
sizeof(ident->drv.driver_ver_str) - 1);
|
|
|
|
mutex_lock(&ionic->dev_cmd_lock);
|
|
|
|
sz = min(sizeof(ident->drv), sizeof(idev->dev_cmd_regs->data));
|
|
memcpy_toio(&idev->dev_cmd_regs->data, &ident->drv, sz);
|
|
|
|
ionic_dev_cmd_identify(idev, IONIC_IDENTITY_VERSION_1);
|
|
err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
|
|
if (!err) {
|
|
sz = min(sizeof(ident->dev), sizeof(idev->dev_cmd_regs->data));
|
|
memcpy_fromio(&ident->dev, &idev->dev_cmd_regs->data, sz);
|
|
}
|
|
mutex_unlock(&ionic->dev_cmd_lock);
|
|
|
|
if (err) {
|
|
dev_err(ionic->dev, "Cannot identify ionic: %d\n", err);
|
|
goto err_out;
|
|
}
|
|
|
|
if (isprint(idev->dev_info.fw_version[0]) &&
|
|
isascii(idev->dev_info.fw_version[0]))
|
|
dev_info(ionic->dev, "FW: %.*s\n",
|
|
(int)(sizeof(idev->dev_info.fw_version) - 1),
|
|
idev->dev_info.fw_version);
|
|
else
|
|
dev_info(ionic->dev, "FW: (invalid string) 0x%02x 0x%02x 0x%02x 0x%02x ...\n",
|
|
(u8)idev->dev_info.fw_version[0],
|
|
(u8)idev->dev_info.fw_version[1],
|
|
(u8)idev->dev_info.fw_version[2],
|
|
(u8)idev->dev_info.fw_version[3]);
|
|
|
|
err = ionic_lif_identify(ionic, IONIC_LIF_TYPE_CLASSIC,
|
|
&ionic->ident.lif);
|
|
if (err) {
|
|
dev_err(ionic->dev, "Cannot identify LIFs: %d\n", err);
|
|
goto err_out;
|
|
}
|
|
|
|
return 0;
|
|
|
|
err_out:
|
|
return err;
|
|
}
|
|
|
|
int ionic_init(struct ionic *ionic)
|
|
{
|
|
struct ionic_dev *idev = &ionic->idev;
|
|
int err;
|
|
|
|
mutex_lock(&ionic->dev_cmd_lock);
|
|
ionic_dev_cmd_init(idev);
|
|
err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
|
|
mutex_unlock(&ionic->dev_cmd_lock);
|
|
|
|
return err;
|
|
}
|
|
|
|
int ionic_reset(struct ionic *ionic)
|
|
{
|
|
struct ionic_dev *idev = &ionic->idev;
|
|
int err;
|
|
|
|
if (!ionic_is_fw_running(idev))
|
|
return 0;
|
|
|
|
mutex_lock(&ionic->dev_cmd_lock);
|
|
ionic_dev_cmd_reset(idev);
|
|
err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
|
|
mutex_unlock(&ionic->dev_cmd_lock);
|
|
|
|
return err;
|
|
}
|
|
|
|
int ionic_port_identify(struct ionic *ionic)
|
|
{
|
|
struct ionic_identity *ident = &ionic->ident;
|
|
struct ionic_dev *idev = &ionic->idev;
|
|
size_t sz;
|
|
int err;
|
|
|
|
mutex_lock(&ionic->dev_cmd_lock);
|
|
|
|
ionic_dev_cmd_port_identify(idev);
|
|
err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
|
|
if (!err) {
|
|
sz = min(sizeof(ident->port), sizeof(idev->dev_cmd_regs->data));
|
|
memcpy_fromio(&ident->port, &idev->dev_cmd_regs->data, sz);
|
|
}
|
|
|
|
mutex_unlock(&ionic->dev_cmd_lock);
|
|
|
|
return err;
|
|
}
|
|
|
|
int ionic_port_init(struct ionic *ionic)
|
|
{
|
|
struct ionic_identity *ident = &ionic->ident;
|
|
struct ionic_dev *idev = &ionic->idev;
|
|
size_t sz;
|
|
int err;
|
|
|
|
if (!idev->port_info) {
|
|
idev->port_info_sz = ALIGN(sizeof(*idev->port_info), PAGE_SIZE);
|
|
idev->port_info = dma_alloc_coherent(ionic->dev,
|
|
idev->port_info_sz,
|
|
&idev->port_info_pa,
|
|
GFP_KERNEL);
|
|
if (!idev->port_info)
|
|
return -ENOMEM;
|
|
}
|
|
|
|
sz = min(sizeof(ident->port.config), sizeof(idev->dev_cmd_regs->data));
|
|
|
|
mutex_lock(&ionic->dev_cmd_lock);
|
|
|
|
memcpy_toio(&idev->dev_cmd_regs->data, &ident->port.config, sz);
|
|
ionic_dev_cmd_port_init(idev);
|
|
err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
|
|
|
|
ionic_dev_cmd_port_state(&ionic->idev, IONIC_PORT_ADMIN_STATE_UP);
|
|
(void)ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
|
|
|
|
mutex_unlock(&ionic->dev_cmd_lock);
|
|
if (err) {
|
|
dev_err(ionic->dev, "Failed to init port\n");
|
|
dma_free_coherent(ionic->dev, idev->port_info_sz,
|
|
idev->port_info, idev->port_info_pa);
|
|
idev->port_info = NULL;
|
|
idev->port_info_pa = 0;
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
int ionic_port_reset(struct ionic *ionic)
|
|
{
|
|
struct ionic_dev *idev = &ionic->idev;
|
|
int err = 0;
|
|
|
|
if (!idev->port_info)
|
|
return 0;
|
|
|
|
if (ionic_is_fw_running(idev)) {
|
|
mutex_lock(&ionic->dev_cmd_lock);
|
|
ionic_dev_cmd_port_reset(idev);
|
|
err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
|
|
mutex_unlock(&ionic->dev_cmd_lock);
|
|
}
|
|
|
|
dma_free_coherent(ionic->dev, idev->port_info_sz,
|
|
idev->port_info, idev->port_info_pa);
|
|
|
|
idev->port_info = NULL;
|
|
idev->port_info_pa = 0;
|
|
|
|
return err;
|
|
}
|
|
|
|
static int __init ionic_init_module(void)
|
|
{
|
|
ionic_debugfs_create();
|
|
return ionic_bus_register_driver();
|
|
}
|
|
|
|
static void __exit ionic_cleanup_module(void)
|
|
{
|
|
ionic_bus_unregister_driver();
|
|
ionic_debugfs_destroy();
|
|
|
|
pr_info("%s removed\n", IONIC_DRV_NAME);
|
|
}
|
|
|
|
module_init(ionic_init_module);
|
|
module_exit(ionic_cleanup_module);
|