162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/* Copyright(c) 2020 Pensando Systems, Inc */
362306a36Sopenharmony_ci
462306a36Sopenharmony_ci#include <linux/kernel.h>
562306a36Sopenharmony_ci#include <linux/types.h>
662306a36Sopenharmony_ci#include <linux/errno.h>
762306a36Sopenharmony_ci#include <linux/firmware.h>
862306a36Sopenharmony_ci
962306a36Sopenharmony_ci#include "ionic.h"
1062306a36Sopenharmony_ci#include "ionic_dev.h"
1162306a36Sopenharmony_ci#include "ionic_lif.h"
1262306a36Sopenharmony_ci#include "ionic_devlink.h"
1362306a36Sopenharmony_ci
1462306a36Sopenharmony_ci/* The worst case wait for the install activity is about 25 minutes when
1562306a36Sopenharmony_ci * installing a new CPLD, which is very seldom.  Normal is about 30-35
1662306a36Sopenharmony_ci * seconds.  Since the driver can't tell if a CPLD update will happen we
1762306a36Sopenharmony_ci * set the timeout for the ugly case.
1862306a36Sopenharmony_ci */
1962306a36Sopenharmony_ci#define IONIC_FW_INSTALL_TIMEOUT	(25 * 60)
2062306a36Sopenharmony_ci#define IONIC_FW_SELECT_TIMEOUT		30
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_ci/* Number of periodic log updates during fw file download */
2362306a36Sopenharmony_ci#define IONIC_FW_INTERVAL_FRACTION	32
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_cistatic void ionic_dev_cmd_firmware_download(struct ionic_dev *idev, u64 addr,
2662306a36Sopenharmony_ci					    u32 offset, u32 length)
2762306a36Sopenharmony_ci{
2862306a36Sopenharmony_ci	union ionic_dev_cmd cmd = {
2962306a36Sopenharmony_ci		.fw_download.opcode = IONIC_CMD_FW_DOWNLOAD,
3062306a36Sopenharmony_ci		.fw_download.offset = cpu_to_le32(offset),
3162306a36Sopenharmony_ci		.fw_download.addr = cpu_to_le64(addr),
3262306a36Sopenharmony_ci		.fw_download.length = cpu_to_le32(length),
3362306a36Sopenharmony_ci	};
3462306a36Sopenharmony_ci
3562306a36Sopenharmony_ci	ionic_dev_cmd_go(idev, &cmd);
3662306a36Sopenharmony_ci}
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_cistatic void ionic_dev_cmd_firmware_install(struct ionic_dev *idev)
3962306a36Sopenharmony_ci{
4062306a36Sopenharmony_ci	union ionic_dev_cmd cmd = {
4162306a36Sopenharmony_ci		.fw_control.opcode = IONIC_CMD_FW_CONTROL,
4262306a36Sopenharmony_ci		.fw_control.oper = IONIC_FW_INSTALL_ASYNC
4362306a36Sopenharmony_ci	};
4462306a36Sopenharmony_ci
4562306a36Sopenharmony_ci	ionic_dev_cmd_go(idev, &cmd);
4662306a36Sopenharmony_ci}
4762306a36Sopenharmony_ci
4862306a36Sopenharmony_cistatic void ionic_dev_cmd_firmware_activate(struct ionic_dev *idev, u8 slot)
4962306a36Sopenharmony_ci{
5062306a36Sopenharmony_ci	union ionic_dev_cmd cmd = {
5162306a36Sopenharmony_ci		.fw_control.opcode = IONIC_CMD_FW_CONTROL,
5262306a36Sopenharmony_ci		.fw_control.oper = IONIC_FW_ACTIVATE_ASYNC,
5362306a36Sopenharmony_ci		.fw_control.slot = slot
5462306a36Sopenharmony_ci	};
5562306a36Sopenharmony_ci
5662306a36Sopenharmony_ci	ionic_dev_cmd_go(idev, &cmd);
5762306a36Sopenharmony_ci}
5862306a36Sopenharmony_ci
5962306a36Sopenharmony_cistatic int ionic_fw_status_long_wait(struct ionic *ionic,
6062306a36Sopenharmony_ci				     const char *label,
6162306a36Sopenharmony_ci				     unsigned long timeout,
6262306a36Sopenharmony_ci				     u8 fw_cmd,
6362306a36Sopenharmony_ci				     struct netlink_ext_ack *extack)
6462306a36Sopenharmony_ci{
6562306a36Sopenharmony_ci	union ionic_dev_cmd cmd = {
6662306a36Sopenharmony_ci		.fw_control.opcode = IONIC_CMD_FW_CONTROL,
6762306a36Sopenharmony_ci		.fw_control.oper = fw_cmd,
6862306a36Sopenharmony_ci	};
6962306a36Sopenharmony_ci	unsigned long start_time;
7062306a36Sopenharmony_ci	unsigned long end_time;
7162306a36Sopenharmony_ci	int err;
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_ci	start_time = jiffies;
7462306a36Sopenharmony_ci	end_time = start_time + (timeout * HZ);
7562306a36Sopenharmony_ci	do {
7662306a36Sopenharmony_ci		mutex_lock(&ionic->dev_cmd_lock);
7762306a36Sopenharmony_ci		ionic_dev_cmd_go(&ionic->idev, &cmd);
7862306a36Sopenharmony_ci		err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
7962306a36Sopenharmony_ci		mutex_unlock(&ionic->dev_cmd_lock);
8062306a36Sopenharmony_ci
8162306a36Sopenharmony_ci		msleep(20);
8262306a36Sopenharmony_ci	} while (time_before(jiffies, end_time) && (err == -EAGAIN || err == -ETIMEDOUT));
8362306a36Sopenharmony_ci
8462306a36Sopenharmony_ci	if (err == -EAGAIN || err == -ETIMEDOUT) {
8562306a36Sopenharmony_ci		NL_SET_ERR_MSG_MOD(extack, "Firmware wait timed out");
8662306a36Sopenharmony_ci		dev_err(ionic->dev, "DEV_CMD firmware wait %s timed out\n", label);
8762306a36Sopenharmony_ci	} else if (err) {
8862306a36Sopenharmony_ci		NL_SET_ERR_MSG_MOD(extack, "Firmware wait failed");
8962306a36Sopenharmony_ci	}
9062306a36Sopenharmony_ci
9162306a36Sopenharmony_ci	return err;
9262306a36Sopenharmony_ci}
9362306a36Sopenharmony_ci
9462306a36Sopenharmony_ciint ionic_firmware_update(struct ionic_lif *lif, const struct firmware *fw,
9562306a36Sopenharmony_ci			  struct netlink_ext_ack *extack)
9662306a36Sopenharmony_ci{
9762306a36Sopenharmony_ci	struct ionic_dev *idev = &lif->ionic->idev;
9862306a36Sopenharmony_ci	struct net_device *netdev = lif->netdev;
9962306a36Sopenharmony_ci	struct ionic *ionic = lif->ionic;
10062306a36Sopenharmony_ci	union ionic_dev_cmd_comp comp;
10162306a36Sopenharmony_ci	u32 buf_sz, copy_sz, offset;
10262306a36Sopenharmony_ci	struct devlink *dl;
10362306a36Sopenharmony_ci	int next_interval;
10462306a36Sopenharmony_ci	int err = 0;
10562306a36Sopenharmony_ci	u8 fw_slot;
10662306a36Sopenharmony_ci
10762306a36Sopenharmony_ci	netdev_info(netdev, "Installing firmware\n");
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_ci	dl = priv_to_devlink(ionic);
11062306a36Sopenharmony_ci	devlink_flash_update_status_notify(dl, "Preparing to flash", NULL, 0, 0);
11162306a36Sopenharmony_ci
11262306a36Sopenharmony_ci	buf_sz = sizeof(idev->dev_cmd_regs->data);
11362306a36Sopenharmony_ci
11462306a36Sopenharmony_ci	netdev_dbg(netdev,
11562306a36Sopenharmony_ci		   "downloading firmware - size %d part_sz %d nparts %lu\n",
11662306a36Sopenharmony_ci		   (int)fw->size, buf_sz, DIV_ROUND_UP(fw->size, buf_sz));
11762306a36Sopenharmony_ci
11862306a36Sopenharmony_ci	offset = 0;
11962306a36Sopenharmony_ci	next_interval = 0;
12062306a36Sopenharmony_ci	while (offset < fw->size) {
12162306a36Sopenharmony_ci		if (offset >= next_interval) {
12262306a36Sopenharmony_ci			devlink_flash_update_status_notify(dl, "Downloading", NULL,
12362306a36Sopenharmony_ci							   offset, fw->size);
12462306a36Sopenharmony_ci			next_interval = offset + (fw->size / IONIC_FW_INTERVAL_FRACTION);
12562306a36Sopenharmony_ci		}
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_ci		copy_sz = min_t(unsigned int, buf_sz, fw->size - offset);
12862306a36Sopenharmony_ci		mutex_lock(&ionic->dev_cmd_lock);
12962306a36Sopenharmony_ci		memcpy_toio(&idev->dev_cmd_regs->data, fw->data + offset, copy_sz);
13062306a36Sopenharmony_ci		ionic_dev_cmd_firmware_download(idev,
13162306a36Sopenharmony_ci						offsetof(union ionic_dev_cmd_regs, data),
13262306a36Sopenharmony_ci						offset, copy_sz);
13362306a36Sopenharmony_ci		err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
13462306a36Sopenharmony_ci		mutex_unlock(&ionic->dev_cmd_lock);
13562306a36Sopenharmony_ci		if (err) {
13662306a36Sopenharmony_ci			netdev_err(netdev,
13762306a36Sopenharmony_ci				   "download failed offset 0x%x addr 0x%lx len 0x%x\n",
13862306a36Sopenharmony_ci				   offset, offsetof(union ionic_dev_cmd_regs, data),
13962306a36Sopenharmony_ci				   copy_sz);
14062306a36Sopenharmony_ci			NL_SET_ERR_MSG_MOD(extack, "Segment download failed");
14162306a36Sopenharmony_ci			goto err_out;
14262306a36Sopenharmony_ci		}
14362306a36Sopenharmony_ci		offset += copy_sz;
14462306a36Sopenharmony_ci	}
14562306a36Sopenharmony_ci	devlink_flash_update_status_notify(dl, "Downloading", NULL,
14662306a36Sopenharmony_ci					   fw->size, fw->size);
14762306a36Sopenharmony_ci
14862306a36Sopenharmony_ci	devlink_flash_update_timeout_notify(dl, "Installing", NULL,
14962306a36Sopenharmony_ci					    IONIC_FW_INSTALL_TIMEOUT);
15062306a36Sopenharmony_ci
15162306a36Sopenharmony_ci	mutex_lock(&ionic->dev_cmd_lock);
15262306a36Sopenharmony_ci	ionic_dev_cmd_firmware_install(idev);
15362306a36Sopenharmony_ci	err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
15462306a36Sopenharmony_ci	ionic_dev_cmd_comp(idev, (union ionic_dev_cmd_comp *)&comp);
15562306a36Sopenharmony_ci	fw_slot = comp.fw_control.slot;
15662306a36Sopenharmony_ci	mutex_unlock(&ionic->dev_cmd_lock);
15762306a36Sopenharmony_ci	if (err) {
15862306a36Sopenharmony_ci		NL_SET_ERR_MSG_MOD(extack, "Failed to start firmware install");
15962306a36Sopenharmony_ci		goto err_out;
16062306a36Sopenharmony_ci	}
16162306a36Sopenharmony_ci
16262306a36Sopenharmony_ci	err = ionic_fw_status_long_wait(ionic, "Installing",
16362306a36Sopenharmony_ci					IONIC_FW_INSTALL_TIMEOUT,
16462306a36Sopenharmony_ci					IONIC_FW_INSTALL_STATUS,
16562306a36Sopenharmony_ci					extack);
16662306a36Sopenharmony_ci	if (err)
16762306a36Sopenharmony_ci		goto err_out;
16862306a36Sopenharmony_ci
16962306a36Sopenharmony_ci	devlink_flash_update_timeout_notify(dl, "Selecting", NULL,
17062306a36Sopenharmony_ci					    IONIC_FW_SELECT_TIMEOUT);
17162306a36Sopenharmony_ci
17262306a36Sopenharmony_ci	mutex_lock(&ionic->dev_cmd_lock);
17362306a36Sopenharmony_ci	ionic_dev_cmd_firmware_activate(idev, fw_slot);
17462306a36Sopenharmony_ci	err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
17562306a36Sopenharmony_ci	mutex_unlock(&ionic->dev_cmd_lock);
17662306a36Sopenharmony_ci	if (err) {
17762306a36Sopenharmony_ci		NL_SET_ERR_MSG_MOD(extack, "Failed to start firmware select");
17862306a36Sopenharmony_ci		goto err_out;
17962306a36Sopenharmony_ci	}
18062306a36Sopenharmony_ci
18162306a36Sopenharmony_ci	err = ionic_fw_status_long_wait(ionic, "Selecting",
18262306a36Sopenharmony_ci					IONIC_FW_SELECT_TIMEOUT,
18362306a36Sopenharmony_ci					IONIC_FW_ACTIVATE_STATUS,
18462306a36Sopenharmony_ci					extack);
18562306a36Sopenharmony_ci	if (err)
18662306a36Sopenharmony_ci		goto err_out;
18762306a36Sopenharmony_ci
18862306a36Sopenharmony_ci	netdev_info(netdev, "Firmware update completed\n");
18962306a36Sopenharmony_ci
19062306a36Sopenharmony_cierr_out:
19162306a36Sopenharmony_ci	if (err)
19262306a36Sopenharmony_ci		devlink_flash_update_status_notify(dl, "Flash failed", NULL, 0, 0);
19362306a36Sopenharmony_ci	else
19462306a36Sopenharmony_ci		devlink_flash_update_status_notify(dl, "Flash done", NULL, 0, 0);
19562306a36Sopenharmony_ci	return err;
19662306a36Sopenharmony_ci}
197