mirror of
https://github.com/torvalds/linux.git
synced 2024-09-20 06:53:04 +00:00
fde25c20f5
CMIS 5.2 standard section 9.4.2 defines four types of firmware update
supported mechanism: None, only LPL, only EPL, both LPL and EPL.
Currently, only LPL (Local Payload) type of write firmware block is
supported. However, if the module supports both LPL and EPL the flashing
process wrongly fails for no supporting LPL.
Fix that, by allowing the write mechanism to be LPL or both LPL and
EPL.
Fixes: c4f78134d4 ("ethtool: cmis_fw_update: add a layer for supporting firmware update using CDB")
Reported-by: Vladyslav Mykhaliuk <vmykhaliuk@nvidia.com>
Signed-off-by: Danielle Ratson <danieller@nvidia.com>
Reviewed-by: Petr Machata <petrm@nvidia.com>
Link: https://patch.msgid.link/20240812140824.3718826-1-danieller@nvidia.com
Signed-off-by: Paolo Abeni <pabeni@redhat.com>
404 lines
11 KiB
C
404 lines
11 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
|
|
#include <linux/ethtool.h>
|
|
#include <linux/firmware.h>
|
|
|
|
#include "common.h"
|
|
#include "module_fw.h"
|
|
#include "cmis.h"
|
|
|
|
struct cmis_fw_update_fw_mng_features {
|
|
u8 start_cmd_payload_size;
|
|
u16 max_duration_start;
|
|
u16 max_duration_write;
|
|
u16 max_duration_complete;
|
|
};
|
|
|
|
/* See section 9.4.2 "CMD 0041h: Firmware Management Features" in CMIS standard
|
|
* revision 5.2.
|
|
* struct cmis_cdb_fw_mng_features_rpl is a structured layout of the flat
|
|
* array, ethtool_cmis_cdb_rpl::payload.
|
|
*/
|
|
struct cmis_cdb_fw_mng_features_rpl {
|
|
u8 resv1;
|
|
u8 resv2;
|
|
u8 start_cmd_payload_size;
|
|
u8 resv3;
|
|
u8 read_write_len_ext;
|
|
u8 write_mechanism;
|
|
u8 resv4;
|
|
u8 resv5;
|
|
__be16 max_duration_start;
|
|
__be16 resv6;
|
|
__be16 max_duration_write;
|
|
__be16 max_duration_complete;
|
|
__be16 resv7;
|
|
};
|
|
|
|
enum cmis_cdb_fw_write_mechanism {
|
|
CMIS_CDB_FW_WRITE_MECHANISM_LPL = 0x01,
|
|
CMIS_CDB_FW_WRITE_MECHANISM_BOTH = 0x11,
|
|
};
|
|
|
|
static int
|
|
cmis_fw_update_fw_mng_features_get(struct ethtool_cmis_cdb *cdb,
|
|
struct net_device *dev,
|
|
struct cmis_fw_update_fw_mng_features *fw_mng,
|
|
struct ethnl_module_fw_flash_ntf_params *ntf_params)
|
|
{
|
|
struct ethtool_cmis_cdb_cmd_args args = {};
|
|
struct cmis_cdb_fw_mng_features_rpl *rpl;
|
|
u8 flags = CDB_F_STATUS_VALID;
|
|
int err;
|
|
|
|
ethtool_cmis_cdb_check_completion_flag(cdb->cmis_rev, &flags);
|
|
ethtool_cmis_cdb_compose_args(&args,
|
|
ETHTOOL_CMIS_CDB_CMD_FW_MANAGMENT_FEATURES,
|
|
NULL, 0, cdb->max_completion_time,
|
|
cdb->read_write_len_ext, 1000,
|
|
sizeof(*rpl), flags);
|
|
|
|
err = ethtool_cmis_cdb_execute_cmd(dev, &args);
|
|
if (err < 0) {
|
|
ethnl_module_fw_flash_ntf_err(dev, ntf_params,
|
|
"FW Management Features command failed",
|
|
args.err_msg);
|
|
return err;
|
|
}
|
|
|
|
rpl = (struct cmis_cdb_fw_mng_features_rpl *)args.req.payload;
|
|
if (!(rpl->write_mechanism == CMIS_CDB_FW_WRITE_MECHANISM_LPL ||
|
|
rpl->write_mechanism == CMIS_CDB_FW_WRITE_MECHANISM_BOTH)) {
|
|
ethnl_module_fw_flash_ntf_err(dev, ntf_params,
|
|
"Write LPL is not supported",
|
|
NULL);
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
/* Above, we used read_write_len_ext that we got from CDB
|
|
* advertisement. Update it with the value that we got from module
|
|
* features query, which is specific for Firmware Management Commands
|
|
* (IDs 0100h-01FFh).
|
|
*/
|
|
cdb->read_write_len_ext = rpl->read_write_len_ext;
|
|
fw_mng->start_cmd_payload_size = rpl->start_cmd_payload_size;
|
|
fw_mng->max_duration_start = be16_to_cpu(rpl->max_duration_start);
|
|
fw_mng->max_duration_write = be16_to_cpu(rpl->max_duration_write);
|
|
fw_mng->max_duration_complete = be16_to_cpu(rpl->max_duration_complete);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* See section 9.7.2 "CMD 0101h: Start Firmware Download" in CMIS standard
|
|
* revision 5.2.
|
|
* struct cmis_cdb_start_fw_download_pl is a structured layout of the
|
|
* flat array, ethtool_cmis_cdb_request::payload.
|
|
*/
|
|
struct cmis_cdb_start_fw_download_pl {
|
|
__struct_group(cmis_cdb_start_fw_download_pl_h, head, /* no attrs */,
|
|
__be32 image_size;
|
|
__be32 resv1;
|
|
);
|
|
u8 vendor_data[ETHTOOL_CMIS_CDB_LPL_MAX_PL_LENGTH -
|
|
sizeof(struct cmis_cdb_start_fw_download_pl_h)];
|
|
};
|
|
|
|
static int
|
|
cmis_fw_update_start_download(struct ethtool_cmis_cdb *cdb,
|
|
struct ethtool_cmis_fw_update_params *fw_update,
|
|
struct cmis_fw_update_fw_mng_features *fw_mng)
|
|
{
|
|
u8 vendor_data_size = fw_mng->start_cmd_payload_size;
|
|
struct cmis_cdb_start_fw_download_pl pl = {};
|
|
struct ethtool_cmis_cdb_cmd_args args = {};
|
|
u8 lpl_len;
|
|
int err;
|
|
|
|
pl.image_size = cpu_to_be32(fw_update->fw->size);
|
|
memcpy(pl.vendor_data, fw_update->fw->data, vendor_data_size);
|
|
|
|
lpl_len = offsetof(struct cmis_cdb_start_fw_download_pl,
|
|
vendor_data[vendor_data_size]);
|
|
|
|
ethtool_cmis_cdb_compose_args(&args,
|
|
ETHTOOL_CMIS_CDB_CMD_START_FW_DOWNLOAD,
|
|
(u8 *)&pl, lpl_len,
|
|
fw_mng->max_duration_start,
|
|
cdb->read_write_len_ext, 1000, 0,
|
|
CDB_F_COMPLETION_VALID | CDB_F_STATUS_VALID);
|
|
|
|
err = ethtool_cmis_cdb_execute_cmd(fw_update->dev, &args);
|
|
if (err < 0)
|
|
ethnl_module_fw_flash_ntf_err(fw_update->dev,
|
|
&fw_update->ntf_params,
|
|
"Start FW download command failed",
|
|
args.err_msg);
|
|
|
|
return err;
|
|
}
|
|
|
|
/* See section 9.7.4 "CMD 0103h: Write Firmware Block LPL" in CMIS standard
|
|
* revision 5.2.
|
|
* struct cmis_cdb_write_fw_block_lpl_pl is a structured layout of the
|
|
* flat array, ethtool_cmis_cdb_request::payload.
|
|
*/
|
|
struct cmis_cdb_write_fw_block_lpl_pl {
|
|
__be32 block_address;
|
|
u8 fw_block[ETHTOOL_CMIS_CDB_LPL_MAX_PL_LENGTH - sizeof(__be32)];
|
|
};
|
|
|
|
static int
|
|
cmis_fw_update_write_image(struct ethtool_cmis_cdb *cdb,
|
|
struct ethtool_cmis_fw_update_params *fw_update,
|
|
struct cmis_fw_update_fw_mng_features *fw_mng)
|
|
{
|
|
u8 start = fw_mng->start_cmd_payload_size;
|
|
u32 offset, max_block_size, max_lpl_len;
|
|
u32 image_size = fw_update->fw->size;
|
|
int err;
|
|
|
|
max_lpl_len = min_t(u32,
|
|
ethtool_cmis_get_max_payload_size(cdb->read_write_len_ext),
|
|
ETHTOOL_CMIS_CDB_LPL_MAX_PL_LENGTH);
|
|
max_block_size =
|
|
max_lpl_len - sizeof_field(struct cmis_cdb_write_fw_block_lpl_pl,
|
|
block_address);
|
|
|
|
for (offset = start; offset < image_size; offset += max_block_size) {
|
|
struct cmis_cdb_write_fw_block_lpl_pl pl = {
|
|
.block_address = cpu_to_be32(offset - start),
|
|
};
|
|
struct ethtool_cmis_cdb_cmd_args args = {};
|
|
u32 block_size, lpl_len;
|
|
|
|
ethnl_module_fw_flash_ntf_in_progress(fw_update->dev,
|
|
&fw_update->ntf_params,
|
|
offset - start,
|
|
image_size);
|
|
block_size = min_t(u32, max_block_size, image_size - offset);
|
|
memcpy(pl.fw_block, &fw_update->fw->data[offset], block_size);
|
|
lpl_len = block_size +
|
|
sizeof_field(struct cmis_cdb_write_fw_block_lpl_pl,
|
|
block_address);
|
|
|
|
ethtool_cmis_cdb_compose_args(&args,
|
|
ETHTOOL_CMIS_CDB_CMD_WRITE_FW_BLOCK_LPL,
|
|
(u8 *)&pl, lpl_len,
|
|
fw_mng->max_duration_write,
|
|
cdb->read_write_len_ext, 1, 0,
|
|
CDB_F_COMPLETION_VALID | CDB_F_STATUS_VALID);
|
|
|
|
err = ethtool_cmis_cdb_execute_cmd(fw_update->dev, &args);
|
|
if (err < 0) {
|
|
ethnl_module_fw_flash_ntf_err(fw_update->dev,
|
|
&fw_update->ntf_params,
|
|
"Write FW block LPL command failed",
|
|
args.err_msg);
|
|
return err;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
cmis_fw_update_complete_download(struct ethtool_cmis_cdb *cdb,
|
|
struct net_device *dev,
|
|
struct cmis_fw_update_fw_mng_features *fw_mng,
|
|
struct ethnl_module_fw_flash_ntf_params *ntf_params)
|
|
{
|
|
struct ethtool_cmis_cdb_cmd_args args = {};
|
|
int err;
|
|
|
|
ethtool_cmis_cdb_compose_args(&args,
|
|
ETHTOOL_CMIS_CDB_CMD_COMPLETE_FW_DOWNLOAD,
|
|
NULL, 0, fw_mng->max_duration_complete,
|
|
cdb->read_write_len_ext, 1000, 0,
|
|
CDB_F_COMPLETION_VALID | CDB_F_STATUS_VALID);
|
|
|
|
err = ethtool_cmis_cdb_execute_cmd(dev, &args);
|
|
if (err < 0)
|
|
ethnl_module_fw_flash_ntf_err(dev, ntf_params,
|
|
"Complete FW download command failed",
|
|
args.err_msg);
|
|
|
|
return err;
|
|
}
|
|
|
|
static int
|
|
cmis_fw_update_download_image(struct ethtool_cmis_cdb *cdb,
|
|
struct ethtool_cmis_fw_update_params *fw_update,
|
|
struct cmis_fw_update_fw_mng_features *fw_mng)
|
|
{
|
|
int err;
|
|
|
|
err = cmis_fw_update_start_download(cdb, fw_update, fw_mng);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
err = cmis_fw_update_write_image(cdb, fw_update, fw_mng);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
err = cmis_fw_update_complete_download(cdb, fw_update->dev, fw_mng,
|
|
&fw_update->ntf_params);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
return 0;
|
|
}
|
|
|
|
enum {
|
|
CMIS_MODULE_LOW_PWR = 1,
|
|
CMIS_MODULE_READY = 3,
|
|
};
|
|
|
|
static bool module_is_ready(u8 data)
|
|
{
|
|
u8 state = (data >> 1) & 7;
|
|
|
|
return state == CMIS_MODULE_READY || state == CMIS_MODULE_LOW_PWR;
|
|
}
|
|
|
|
#define CMIS_MODULE_READY_MAX_DURATION_MSEC 1000
|
|
#define CMIS_MODULE_STATE_OFFSET 3
|
|
|
|
static int
|
|
cmis_fw_update_wait_for_module_state(struct net_device *dev, u8 flags)
|
|
{
|
|
u8 state;
|
|
|
|
return ethtool_cmis_wait_for_cond(dev, flags, CDB_F_MODULE_STATE_VALID,
|
|
CMIS_MODULE_READY_MAX_DURATION_MSEC,
|
|
CMIS_MODULE_STATE_OFFSET,
|
|
module_is_ready, NULL, &state);
|
|
}
|
|
|
|
/* See section 9.7.10 "CMD 0109h: Run Firmware Image" in CMIS standard
|
|
* revision 5.2.
|
|
* struct cmis_cdb_run_fw_image_pl is a structured layout of the flat
|
|
* array, ethtool_cmis_cdb_request::payload.
|
|
*/
|
|
struct cmis_cdb_run_fw_image_pl {
|
|
u8 resv1;
|
|
u8 image_to_run;
|
|
u16 delay_to_reset;
|
|
};
|
|
|
|
static int
|
|
cmis_fw_update_run_image(struct ethtool_cmis_cdb *cdb, struct net_device *dev,
|
|
struct ethnl_module_fw_flash_ntf_params *ntf_params)
|
|
{
|
|
struct ethtool_cmis_cdb_cmd_args args = {};
|
|
struct cmis_cdb_run_fw_image_pl pl = {0};
|
|
int err;
|
|
|
|
ethtool_cmis_cdb_compose_args(&args, ETHTOOL_CMIS_CDB_CMD_RUN_FW_IMAGE,
|
|
(u8 *)&pl, sizeof(pl),
|
|
cdb->max_completion_time,
|
|
cdb->read_write_len_ext, 1000, 0,
|
|
CDB_F_MODULE_STATE_VALID);
|
|
|
|
err = ethtool_cmis_cdb_execute_cmd(dev, &args);
|
|
if (err < 0) {
|
|
ethnl_module_fw_flash_ntf_err(dev, ntf_params,
|
|
"Run image command failed",
|
|
args.err_msg);
|
|
return err;
|
|
}
|
|
|
|
err = cmis_fw_update_wait_for_module_state(dev, args.flags);
|
|
if (err < 0)
|
|
ethnl_module_fw_flash_ntf_err(dev, ntf_params,
|
|
"Module is not ready on time after reset",
|
|
NULL);
|
|
|
|
return err;
|
|
}
|
|
|
|
static int
|
|
cmis_fw_update_commit_image(struct ethtool_cmis_cdb *cdb,
|
|
struct net_device *dev,
|
|
struct ethnl_module_fw_flash_ntf_params *ntf_params)
|
|
{
|
|
struct ethtool_cmis_cdb_cmd_args args = {};
|
|
int err;
|
|
|
|
ethtool_cmis_cdb_compose_args(&args,
|
|
ETHTOOL_CMIS_CDB_CMD_COMMIT_FW_IMAGE,
|
|
NULL, 0, cdb->max_completion_time,
|
|
cdb->read_write_len_ext, 1000, 0,
|
|
CDB_F_COMPLETION_VALID | CDB_F_STATUS_VALID);
|
|
|
|
err = ethtool_cmis_cdb_execute_cmd(dev, &args);
|
|
if (err < 0)
|
|
ethnl_module_fw_flash_ntf_err(dev, ntf_params,
|
|
"Commit image command failed",
|
|
args.err_msg);
|
|
|
|
return err;
|
|
}
|
|
|
|
static int cmis_fw_update_reset(struct net_device *dev)
|
|
{
|
|
__u32 reset_data = ETH_RESET_PHY;
|
|
|
|
return dev->ethtool_ops->reset(dev, &reset_data);
|
|
}
|
|
|
|
void
|
|
ethtool_cmis_fw_update(struct ethtool_cmis_fw_update_params *fw_update)
|
|
{
|
|
struct ethnl_module_fw_flash_ntf_params *ntf_params =
|
|
&fw_update->ntf_params;
|
|
struct cmis_fw_update_fw_mng_features fw_mng = {0};
|
|
struct net_device *dev = fw_update->dev;
|
|
struct ethtool_cmis_cdb *cdb;
|
|
int err;
|
|
|
|
cdb = ethtool_cmis_cdb_init(dev, &fw_update->params, ntf_params);
|
|
if (IS_ERR(cdb))
|
|
goto err_send_ntf;
|
|
|
|
ethnl_module_fw_flash_ntf_start(dev, ntf_params);
|
|
|
|
err = cmis_fw_update_fw_mng_features_get(cdb, dev, &fw_mng, ntf_params);
|
|
if (err < 0)
|
|
goto err_cdb_fini;
|
|
|
|
err = cmis_fw_update_download_image(cdb, fw_update, &fw_mng);
|
|
if (err < 0)
|
|
goto err_cdb_fini;
|
|
|
|
err = cmis_fw_update_run_image(cdb, dev, ntf_params);
|
|
if (err < 0)
|
|
goto err_cdb_fini;
|
|
|
|
/* The CDB command "Run Firmware Image" resets the firmware, so the new
|
|
* one might have different settings.
|
|
* Free the old CDB instance, and init a new one.
|
|
*/
|
|
ethtool_cmis_cdb_fini(cdb);
|
|
|
|
cdb = ethtool_cmis_cdb_init(dev, &fw_update->params, ntf_params);
|
|
if (IS_ERR(cdb))
|
|
goto err_send_ntf;
|
|
|
|
err = cmis_fw_update_commit_image(cdb, dev, ntf_params);
|
|
if (err < 0)
|
|
goto err_cdb_fini;
|
|
|
|
err = cmis_fw_update_reset(dev);
|
|
if (err < 0)
|
|
goto err_cdb_fini;
|
|
|
|
ethnl_module_fw_flash_ntf_complete(dev, ntf_params);
|
|
ethtool_cmis_cdb_fini(cdb);
|
|
return;
|
|
|
|
err_cdb_fini:
|
|
ethtool_cmis_cdb_fini(cdb);
|
|
err_send_ntf:
|
|
ethnl_module_fw_flash_ntf_err(dev, ntf_params, NULL, NULL);
|
|
}
|