479 lines
14 KiB
C
479 lines
14 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/* Copyright(c) 2013 - 2020 Intel Corporation. */
|
|
|
|
#include "i40e.h"
|
|
|
|
#include <linux/firmware.h>
|
|
|
|
/**
|
|
* i40e_ddp_profiles_eq - checks if DDP profiles are the equivalent
|
|
* @a: new profile info
|
|
* @b: old profile info
|
|
*
|
|
* checks if DDP profiles are the equivalent.
|
|
* Returns true if profiles are the same.
|
|
**/
|
|
static bool i40e_ddp_profiles_eq(struct i40e_profile_info *a,
|
|
struct i40e_profile_info *b)
|
|
{
|
|
return a->track_id == b->track_id &&
|
|
!memcmp(&a->version, &b->version, sizeof(a->version)) &&
|
|
!memcmp(&a->name, &b->name, I40E_DDP_NAME_SIZE);
|
|
}
|
|
|
|
/**
|
|
* i40e_ddp_does_profile_exist - checks if DDP profile loaded already
|
|
* @hw: HW data structure
|
|
* @pinfo: DDP profile information structure
|
|
*
|
|
* checks if DDP profile loaded already.
|
|
* Returns >0 if the profile exists.
|
|
* Returns 0 if the profile is absent.
|
|
* Returns <0 if error.
|
|
**/
|
|
static int i40e_ddp_does_profile_exist(struct i40e_hw *hw,
|
|
struct i40e_profile_info *pinfo)
|
|
{
|
|
struct i40e_ddp_profile_list *profile_list;
|
|
u8 buff[I40E_PROFILE_LIST_SIZE];
|
|
i40e_status status;
|
|
int i;
|
|
|
|
status = i40e_aq_get_ddp_list(hw, buff, I40E_PROFILE_LIST_SIZE, 0,
|
|
NULL);
|
|
if (status != I40E_SUCCESS)
|
|
return -1;
|
|
|
|
profile_list = (struct i40e_ddp_profile_list *)buff;
|
|
for (i = 0; i < profile_list->p_count; i++) {
|
|
if (i40e_ddp_profiles_eq(pinfo, &profile_list->p_info[i]))
|
|
return 1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* i40e_ddp_profiles_overlap - checks if DDP profiles overlap.
|
|
* @new: new profile info
|
|
* @old: old profile info
|
|
*
|
|
* checks if DDP profiles overlap.
|
|
* Returns true if profiles are overlap.
|
|
**/
|
|
static bool i40e_ddp_profiles_overlap(struct i40e_profile_info *new,
|
|
struct i40e_profile_info *old)
|
|
{
|
|
unsigned int group_id_old = (u8)((old->track_id & 0x00FF0000) >> 16);
|
|
unsigned int group_id_new = (u8)((new->track_id & 0x00FF0000) >> 16);
|
|
|
|
/* 0x00 group must be only the first */
|
|
if (group_id_new == 0)
|
|
return true;
|
|
/* 0xFF group is compatible with anything else */
|
|
if (group_id_new == 0xFF || group_id_old == 0xFF)
|
|
return false;
|
|
/* otherwise only profiles from the same group are compatible*/
|
|
return group_id_old != group_id_new;
|
|
}
|
|
|
|
/**
|
|
* i40e_ddp_does_profiles_ - checks if DDP overlaps with existing one.
|
|
* @hw: HW data structure
|
|
* @pinfo: DDP profile information structure
|
|
*
|
|
* checks if DDP profile overlaps with existing one.
|
|
* Returns >0 if the profile overlaps.
|
|
* Returns 0 if the profile is ok.
|
|
* Returns <0 if error.
|
|
**/
|
|
static int i40e_ddp_does_profile_overlap(struct i40e_hw *hw,
|
|
struct i40e_profile_info *pinfo)
|
|
{
|
|
struct i40e_ddp_profile_list *profile_list;
|
|
u8 buff[I40E_PROFILE_LIST_SIZE];
|
|
i40e_status status;
|
|
int i;
|
|
|
|
status = i40e_aq_get_ddp_list(hw, buff, I40E_PROFILE_LIST_SIZE, 0,
|
|
NULL);
|
|
if (status != I40E_SUCCESS)
|
|
return -EIO;
|
|
|
|
profile_list = (struct i40e_ddp_profile_list *)buff;
|
|
for (i = 0; i < profile_list->p_count; i++) {
|
|
if (i40e_ddp_profiles_overlap(pinfo,
|
|
&profile_list->p_info[i]))
|
|
return 1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* i40e_add_pinfo
|
|
* @hw: pointer to the hardware structure
|
|
* @profile: pointer to the profile segment of the package
|
|
* @profile_info_sec: buffer for information section
|
|
* @track_id: package tracking id
|
|
*
|
|
* Register a profile to the list of loaded profiles.
|
|
*/
|
|
static enum i40e_status_code
|
|
i40e_add_pinfo(struct i40e_hw *hw, struct i40e_profile_segment *profile,
|
|
u8 *profile_info_sec, u32 track_id)
|
|
{
|
|
struct i40e_profile_section_header *sec;
|
|
struct i40e_profile_info *pinfo;
|
|
i40e_status status;
|
|
u32 offset = 0, info = 0;
|
|
|
|
sec = (struct i40e_profile_section_header *)profile_info_sec;
|
|
sec->tbl_size = 1;
|
|
sec->data_end = sizeof(struct i40e_profile_section_header) +
|
|
sizeof(struct i40e_profile_info);
|
|
sec->section.type = SECTION_TYPE_INFO;
|
|
sec->section.offset = sizeof(struct i40e_profile_section_header);
|
|
sec->section.size = sizeof(struct i40e_profile_info);
|
|
pinfo = (struct i40e_profile_info *)(profile_info_sec +
|
|
sec->section.offset);
|
|
pinfo->track_id = track_id;
|
|
pinfo->version = profile->version;
|
|
pinfo->op = I40E_DDP_ADD_TRACKID;
|
|
|
|
/* Clear reserved field */
|
|
memset(pinfo->reserved, 0, sizeof(pinfo->reserved));
|
|
i40e_memcpy(pinfo->name, profile->name, I40E_DDP_NAME_SIZE,
|
|
I40E_NONDMA_TO_NONDMA);
|
|
|
|
status = i40e_aq_write_ddp(hw, (void *)sec, sec->data_end,
|
|
track_id, &offset, &info, NULL);
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* i40e_del_pinfo - delete DDP profile info from NIC
|
|
* @hw: HW data structure
|
|
* @profile: DDP profile segment to be deleted
|
|
* @profile_info_sec: DDP profile section header
|
|
* @track_id: track ID of the profile for deletion
|
|
*
|
|
* Removes DDP profile from the NIC.
|
|
**/
|
|
static enum i40e_status_code
|
|
i40e_del_pinfo(struct i40e_hw *hw, struct i40e_profile_segment *profile,
|
|
u8 *profile_info_sec, u32 track_id)
|
|
{
|
|
struct i40e_profile_section_header *sec;
|
|
struct i40e_profile_info *pinfo;
|
|
i40e_status status;
|
|
u32 offset = 0, info = 0;
|
|
|
|
sec = (struct i40e_profile_section_header *)profile_info_sec;
|
|
sec->tbl_size = 1;
|
|
sec->data_end = sizeof(struct i40e_profile_section_header) +
|
|
sizeof(struct i40e_profile_info);
|
|
sec->section.type = SECTION_TYPE_INFO;
|
|
sec->section.offset = sizeof(struct i40e_profile_section_header);
|
|
sec->section.size = sizeof(struct i40e_profile_info);
|
|
pinfo = (struct i40e_profile_info *)(profile_info_sec +
|
|
sec->section.offset);
|
|
pinfo->track_id = track_id;
|
|
pinfo->version = profile->version;
|
|
pinfo->op = I40E_DDP_REMOVE_TRACKID;
|
|
|
|
/* Clear reserved field */
|
|
memset(pinfo->reserved, 0, sizeof(pinfo->reserved));
|
|
memcpy(pinfo->name, profile->name, I40E_DDP_NAME_SIZE);
|
|
|
|
status = i40e_aq_write_ddp(hw, (void *)sec, sec->data_end,
|
|
track_id, &offset, &info, NULL);
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* i40e_ddp_is_pkg_hdr_valid - performs basic pkg header integrity checks
|
|
* @netdev: net device structure (for logging purposes)
|
|
* @pkg_hdr: pointer to package header
|
|
* @size_huge: size of the whole DDP profile package in size_t
|
|
*
|
|
* Checks correctness of pkg header: Version, size too big/small, and
|
|
* all segment offsets alignment and boundaries. This function lets
|
|
* reject non DDP profile file to be loaded by administrator mistake.
|
|
**/
|
|
static bool i40e_ddp_is_pkg_hdr_valid(struct net_device *netdev,
|
|
struct i40e_package_header *pkg_hdr,
|
|
size_t size_huge)
|
|
{
|
|
u32 size = 0xFFFFFFFFU & size_huge;
|
|
u32 pkg_hdr_size;
|
|
u32 segment;
|
|
|
|
if (!pkg_hdr)
|
|
return false;
|
|
|
|
if (pkg_hdr->version.major > 0) {
|
|
struct i40e_ddp_version ver = pkg_hdr->version;
|
|
netdev_err(netdev, "Unsupported DDP profile version %u.%u.%u.%u",
|
|
ver.major, ver.minor, ver.update, ver.draft);
|
|
return false;
|
|
}
|
|
if (size_huge > size) {
|
|
netdev_err(netdev, "Invalid DDP profile - size is bigger than 4G");
|
|
return false;
|
|
}
|
|
if (size < (sizeof(struct i40e_package_header) +
|
|
sizeof(struct i40e_metadata_segment) + sizeof(u32) * 2)) {
|
|
netdev_err(netdev, "Invalid DDP profile - size is too small.");
|
|
return false;
|
|
}
|
|
|
|
pkg_hdr_size = sizeof(u32) * (pkg_hdr->segment_count + 2U);
|
|
if (size < pkg_hdr_size) {
|
|
netdev_err(netdev, "Invalid DDP profile - too many segments");
|
|
return false;
|
|
}
|
|
for (segment = 0; segment < pkg_hdr->segment_count; ++segment) {
|
|
u32 offset = pkg_hdr->segment_offset[segment];
|
|
|
|
if (0xFU & offset) {
|
|
netdev_err(netdev, "Invalid DDP profile %u segment alignment", segment);
|
|
return false;
|
|
}
|
|
if (pkg_hdr_size > offset || offset >= size) {
|
|
netdev_err(netdev, "Invalid DDP profile %u segment offset", segment);
|
|
return false;
|
|
}
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
/**
|
|
* i40e_ddp_load - performs DDP loading
|
|
* @netdev: net device structure
|
|
* @data: buffer containing recipe file
|
|
* @size: size of the buffer
|
|
* @is_add: true when loading profile, false when rolling back the previous one
|
|
*
|
|
* Checks correctness and loads DDP profile to the NIC. The function is
|
|
* also used for rolling back previously loaded profile.
|
|
**/
|
|
int i40e_ddp_load(struct net_device *netdev, const u8 *data, size_t size,
|
|
bool is_add)
|
|
{
|
|
u8 profile_info_sec[sizeof(struct i40e_profile_section_header) +
|
|
sizeof(struct i40e_profile_info)];
|
|
struct i40e_metadata_segment *metadata_hdr;
|
|
struct i40e_profile_segment *profile_hdr;
|
|
struct i40e_profile_info pinfo;
|
|
struct i40e_package_header *pkg_hdr;
|
|
i40e_status status;
|
|
struct i40e_netdev_priv *np = netdev_priv(netdev);
|
|
struct i40e_vsi *vsi = np->vsi;
|
|
struct i40e_pf *pf = vsi->back;
|
|
u32 track_id;
|
|
int istatus;
|
|
|
|
pkg_hdr = (struct i40e_package_header *)data;
|
|
if (!i40e_ddp_is_pkg_hdr_valid(netdev, pkg_hdr, size))
|
|
return -EINVAL;
|
|
|
|
if (size < (sizeof(struct i40e_package_header) +
|
|
sizeof(struct i40e_metadata_segment) + sizeof(u32) * 2)) {
|
|
netdev_err(netdev, "Invalid DDP recipe size.");
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Find beginning of segment data in buffer */
|
|
metadata_hdr = (struct i40e_metadata_segment *)
|
|
i40e_find_segment_in_package(SEGMENT_TYPE_METADATA, pkg_hdr);
|
|
if (!metadata_hdr) {
|
|
netdev_err(netdev, "Failed to find metadata segment in DDP recipe.");
|
|
return -EINVAL;
|
|
}
|
|
|
|
track_id = metadata_hdr->track_id;
|
|
profile_hdr = (struct i40e_profile_segment *)
|
|
i40e_find_segment_in_package(SEGMENT_TYPE_I40E, pkg_hdr);
|
|
if (!profile_hdr) {
|
|
netdev_err(netdev, "Failed to find profile segment in DDP recipe.");
|
|
return -EINVAL;
|
|
}
|
|
|
|
pinfo.track_id = track_id;
|
|
pinfo.version = profile_hdr->version;
|
|
if (is_add)
|
|
pinfo.op = I40E_DDP_ADD_TRACKID;
|
|
else
|
|
pinfo.op = I40E_DDP_REMOVE_TRACKID;
|
|
|
|
memcpy(pinfo.name, profile_hdr->name, I40E_DDP_NAME_SIZE);
|
|
|
|
/* Check if profile data already exists*/
|
|
istatus = i40e_ddp_does_profile_exist(&pf->hw, &pinfo);
|
|
if (istatus < 0) {
|
|
netdev_err(netdev, "Failed to fetch loaded profiles.");
|
|
return istatus;
|
|
}
|
|
if (is_add) {
|
|
if (istatus > 0) {
|
|
netdev_err(netdev, "DDP profile already loaded.");
|
|
return -EINVAL;
|
|
}
|
|
istatus = i40e_ddp_does_profile_overlap(&pf->hw, &pinfo);
|
|
if (istatus < 0) {
|
|
netdev_err(netdev, "Failed to fetch loaded profiles.");
|
|
return istatus;
|
|
}
|
|
if (istatus > 0) {
|
|
netdev_err(netdev, "DDP profile overlaps with existing one.");
|
|
return -EINVAL;
|
|
}
|
|
} else {
|
|
if (istatus == 0) {
|
|
netdev_err(netdev,
|
|
"DDP profile for deletion does not exist.");
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
/* Load profile data */
|
|
if (is_add) {
|
|
status = i40e_write_profile(&pf->hw, profile_hdr, track_id);
|
|
if (status) {
|
|
if (status == I40E_ERR_DEVICE_NOT_SUPPORTED) {
|
|
netdev_err(netdev, "Profile is not supported by the device.");
|
|
return -EPERM;
|
|
}
|
|
netdev_err(netdev, "Failed to write DDP profile.");
|
|
return -EIO;
|
|
}
|
|
} else {
|
|
status = i40e_rollback_profile(&pf->hw, profile_hdr, track_id);
|
|
if (status) {
|
|
netdev_err(netdev, "Failed to remove DDP profile.");
|
|
return -EIO;
|
|
}
|
|
}
|
|
|
|
/* Add/remove profile to/from profile list in FW */
|
|
if (is_add) {
|
|
status = i40e_add_pinfo(&pf->hw, profile_hdr, profile_info_sec,
|
|
track_id);
|
|
if (status) {
|
|
netdev_err(netdev, "Failed to add DDP profile info.");
|
|
return -EIO;
|
|
}
|
|
} else {
|
|
status = i40e_del_pinfo(&pf->hw, profile_hdr, profile_info_sec,
|
|
track_id);
|
|
if (status) {
|
|
netdev_err(netdev, "Failed to restore DDP profile info.");
|
|
return -EIO;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* i40e_ddp_restore - restore previously loaded profile and remove from list
|
|
* @pf: PF data struct
|
|
*
|
|
* Restores previously loaded profile stored on the list in driver memory.
|
|
* After rolling back removes entry from the list.
|
|
**/
|
|
static int i40e_ddp_restore(struct i40e_pf *pf)
|
|
{
|
|
struct i40e_ddp_old_profile_list *entry;
|
|
struct net_device *netdev = pf->vsi[pf->lan_vsi]->netdev;
|
|
int status = 0;
|
|
|
|
if (!list_empty(&pf->ddp_old_prof)) {
|
|
entry = list_first_entry(&pf->ddp_old_prof,
|
|
struct i40e_ddp_old_profile_list,
|
|
list);
|
|
status = i40e_ddp_load(netdev, entry->old_ddp_buf,
|
|
entry->old_ddp_size, false);
|
|
list_del(&entry->list);
|
|
kfree(entry);
|
|
}
|
|
return status;
|
|
}
|
|
|
|
#define I40E_DDP_PROFILE_NAME_MAX \
|
|
(sizeof(I40E_DDP_PROFILE_PATH) + ETHTOOL_FLASH_MAX_FILENAME)
|
|
|
|
/**
|
|
* i40e_ddp_flash - callback function for ethtool flash feature
|
|
* @netdev: net device structure
|
|
* @flash: kernel flash structure
|
|
*
|
|
* Ethtool callback function used for loading and unloading DDP profiles.
|
|
**/
|
|
int i40e_ddp_flash(struct net_device *netdev, struct ethtool_flash *flash)
|
|
{
|
|
const struct firmware *ddp_config;
|
|
struct i40e_netdev_priv *np = netdev_priv(netdev);
|
|
struct i40e_vsi *vsi = np->vsi;
|
|
struct i40e_pf *pf = vsi->back;
|
|
int status = 0;
|
|
|
|
/* Check for valid region first */
|
|
if (flash->region != I40_DDP_FLASH_REGION) {
|
|
netdev_err(netdev, "Requested firmware region is not recognized by this driver.");
|
|
return -EINVAL;
|
|
}
|
|
if (pf->hw.bus.func != 0) {
|
|
netdev_err(netdev, "Any DDP operation is allowed only on Phy0 NIC interface");
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* If the user supplied "-" instead of file name rollback previously
|
|
* stored profile.
|
|
*/
|
|
if (strncmp(flash->data, "-", 2) != 0) {
|
|
struct i40e_ddp_old_profile_list *list_entry;
|
|
char profile_name[I40E_DDP_PROFILE_NAME_MAX];
|
|
|
|
profile_name[sizeof(profile_name)-1]=0;
|
|
strncpy(profile_name, I40E_DDP_PROFILE_PATH, sizeof(profile_name)-1);
|
|
strncat(profile_name, flash->data, ETHTOOL_FLASH_MAX_FILENAME);
|
|
/* Load DDP recipe. */
|
|
status = request_firmware(&ddp_config, profile_name,
|
|
&netdev->dev);
|
|
if (status) {
|
|
netdev_err(netdev, "DDP recipe file request failed.");
|
|
return status;
|
|
}
|
|
|
|
status = i40e_ddp_load(netdev, ddp_config->data,
|
|
ddp_config->size, true);
|
|
|
|
if (!status) {
|
|
list_entry = kzalloc(
|
|
sizeof(struct i40e_ddp_old_profile_list) +
|
|
ddp_config->size, GFP_KERNEL);
|
|
if (!list_entry) {
|
|
netdev_info(netdev, "Failed to allocate memory for previous DDP profile data.");
|
|
netdev_info(netdev, "New profile loaded but roll-back will be impossible.");
|
|
} else {
|
|
memcpy(list_entry->old_ddp_buf,
|
|
ddp_config->data, ddp_config->size);
|
|
list_entry->old_ddp_size = ddp_config->size;
|
|
list_add(&list_entry->list, &pf->ddp_old_prof);
|
|
}
|
|
}
|
|
|
|
release_firmware(ddp_config);
|
|
} else {
|
|
if (!list_empty(&pf->ddp_old_prof)) {
|
|
status = i40e_ddp_restore(pf);
|
|
} else {
|
|
netdev_warn(netdev, "There is no DDP profile to restore.");
|
|
status = -ENOENT;
|
|
}
|
|
}
|
|
return status;
|
|
}
|