259 lines
		
	
	
		
			7.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			259 lines
		
	
	
		
			7.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Copyright (c) 2018, Mellanox Technologies. All rights reserved.
 | |
|  *
 | |
|  * This software is available to you under a choice of one of two
 | |
|  * licenses.  You may choose to be licensed under the terms of the GNU
 | |
|  * General Public License (GPL) Version 2, available from the file
 | |
|  * COPYING in the main directory of this source tree, or the
 | |
|  * OpenIB.org BSD license below:
 | |
|  *
 | |
|  *     Redistribution and use in source and binary forms, with or
 | |
|  *     without modification, are permitted provided that the following
 | |
|  *     conditions are met:
 | |
|  *
 | |
|  *      - Redistributions of source code must retain the above
 | |
|  *        copyright notice, this list of conditions and the following
 | |
|  *        disclaimer.
 | |
|  *
 | |
|  *      - Redistributions in binary form must reproduce the above
 | |
|  *        copyright notice, this list of conditions and the following
 | |
|  *        disclaimer in the documentation and/or other materials
 | |
|  *        provided with the distribution.
 | |
|  *
 | |
|  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 | |
|  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 | |
|  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 | |
|  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
 | |
|  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
 | |
|  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
 | |
|  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
 | |
|  * SOFTWARE.
 | |
|  */
 | |
| 
 | |
| #include "mlx4.h"
 | |
| 
 | |
| #define BAD_ACCESS			0xBADACCE5
 | |
| #define HEALTH_BUFFER_SIZE		0x40
 | |
| #define CR_ENABLE_BIT			swab32(BIT(6))
 | |
| #define CR_ENABLE_BIT_OFFSET		0xF3F04
 | |
| #define MAX_NUM_OF_DUMPS_TO_STORE	(8)
 | |
| 
 | |
| #define REGION_CR_SPACE "cr-space"
 | |
| #define REGION_FW_HEALTH "fw-health"
 | |
| 
 | |
| static const char * const region_cr_space_str = REGION_CR_SPACE;
 | |
| static const char * const region_fw_health_str = REGION_FW_HEALTH;
 | |
| 
 | |
| static const struct devlink_region_ops region_cr_space_ops = {
 | |
| 	.name = REGION_CR_SPACE,
 | |
| 	.destructor = &kvfree,
 | |
| };
 | |
| 
 | |
| static const struct devlink_region_ops region_fw_health_ops = {
 | |
| 	.name = REGION_FW_HEALTH,
 | |
| 	.destructor = &kvfree,
 | |
| };
 | |
| 
 | |
| /* Set to true in case cr enable bit was set to true before crdump */
 | |
| static bool crdump_enbale_bit_set;
 | |
| 
 | |
| static void crdump_enable_crspace_access(struct mlx4_dev *dev,
 | |
| 					 u8 __iomem *cr_space)
 | |
| {
 | |
| 	/* Get current enable bit value */
 | |
| 	crdump_enbale_bit_set =
 | |
| 		readl(cr_space + CR_ENABLE_BIT_OFFSET) & CR_ENABLE_BIT;
 | |
| 
 | |
| 	/* Enable FW CR filter (set bit6 to 0) */
 | |
| 	if (crdump_enbale_bit_set)
 | |
| 		writel(readl(cr_space + CR_ENABLE_BIT_OFFSET) & ~CR_ENABLE_BIT,
 | |
| 		       cr_space + CR_ENABLE_BIT_OFFSET);
 | |
| 
 | |
| 	/* Enable block volatile crspace accesses */
 | |
| 	writel(swab32(1), cr_space + dev->caps.health_buffer_addrs +
 | |
| 	       HEALTH_BUFFER_SIZE);
 | |
| }
 | |
| 
 | |
| static void crdump_disable_crspace_access(struct mlx4_dev *dev,
 | |
| 					  u8 __iomem *cr_space)
 | |
| {
 | |
| 	/* Disable block volatile crspace accesses */
 | |
| 	writel(0, cr_space + dev->caps.health_buffer_addrs +
 | |
| 	       HEALTH_BUFFER_SIZE);
 | |
| 
 | |
| 	/* Restore FW CR filter value (set bit6 to original value) */
 | |
| 	if (crdump_enbale_bit_set)
 | |
| 		writel(readl(cr_space + CR_ENABLE_BIT_OFFSET) | CR_ENABLE_BIT,
 | |
| 		       cr_space + CR_ENABLE_BIT_OFFSET);
 | |
| }
 | |
| 
 | |
| static void mlx4_crdump_collect_crspace(struct mlx4_dev *dev,
 | |
| 					u8 __iomem *cr_space,
 | |
| 					u32 id)
 | |
| {
 | |
| 	struct mlx4_fw_crdump *crdump = &dev->persist->crdump;
 | |
| 	struct pci_dev *pdev = dev->persist->pdev;
 | |
| 	unsigned long cr_res_size;
 | |
| 	u8 *crspace_data;
 | |
| 	int offset;
 | |
| 	int err;
 | |
| 
 | |
| 	if (!crdump->region_crspace) {
 | |
| 		mlx4_err(dev, "crdump: cr-space region is NULL\n");
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	/* Try to collect CR space */
 | |
| 	cr_res_size = pci_resource_len(pdev, 0);
 | |
| 	crspace_data = kvmalloc(cr_res_size, GFP_KERNEL);
 | |
| 	if (crspace_data) {
 | |
| 		for (offset = 0; offset < cr_res_size; offset += 4)
 | |
| 			*(u32 *)(crspace_data + offset) =
 | |
| 					readl(cr_space + offset);
 | |
| 
 | |
| 		err = devlink_region_snapshot_create(crdump->region_crspace,
 | |
| 						     crspace_data, id);
 | |
| 		if (err) {
 | |
| 			kvfree(crspace_data);
 | |
| 			mlx4_warn(dev, "crdump: devlink create %s snapshot id %d err %d\n",
 | |
| 				  region_cr_space_str, id, err);
 | |
| 		} else {
 | |
| 			mlx4_info(dev, "crdump: added snapshot %d to devlink region %s\n",
 | |
| 				  id, region_cr_space_str);
 | |
| 		}
 | |
| 	} else {
 | |
| 		mlx4_err(dev, "crdump: Failed to allocate crspace buffer\n");
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void mlx4_crdump_collect_fw_health(struct mlx4_dev *dev,
 | |
| 					  u8 __iomem *cr_space,
 | |
| 					  u32 id)
 | |
| {
 | |
| 	struct mlx4_fw_crdump *crdump = &dev->persist->crdump;
 | |
| 	u8 *health_data;
 | |
| 	int offset;
 | |
| 	int err;
 | |
| 
 | |
| 	if (!crdump->region_fw_health) {
 | |
| 		mlx4_err(dev, "crdump: fw-health region is NULL\n");
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	/* Try to collect health buffer */
 | |
| 	health_data = kvmalloc(HEALTH_BUFFER_SIZE, GFP_KERNEL);
 | |
| 	if (health_data) {
 | |
| 		u8 __iomem *health_buf_start =
 | |
| 				cr_space + dev->caps.health_buffer_addrs;
 | |
| 
 | |
| 		for (offset = 0; offset < HEALTH_BUFFER_SIZE; offset += 4)
 | |
| 			*(u32 *)(health_data + offset) =
 | |
| 					readl(health_buf_start + offset);
 | |
| 
 | |
| 		err = devlink_region_snapshot_create(crdump->region_fw_health,
 | |
| 						     health_data, id);
 | |
| 		if (err) {
 | |
| 			kvfree(health_data);
 | |
| 			mlx4_warn(dev, "crdump: devlink create %s snapshot id %d err %d\n",
 | |
| 				  region_fw_health_str, id, err);
 | |
| 		} else {
 | |
| 			mlx4_info(dev, "crdump: added snapshot %d to devlink region %s\n",
 | |
| 				  id, region_fw_health_str);
 | |
| 		}
 | |
| 	} else {
 | |
| 		mlx4_err(dev, "crdump: Failed to allocate health buffer\n");
 | |
| 	}
 | |
| }
 | |
| 
 | |
| int mlx4_crdump_collect(struct mlx4_dev *dev)
 | |
| {
 | |
| 	struct devlink *devlink = priv_to_devlink(mlx4_priv(dev));
 | |
| 	struct mlx4_fw_crdump *crdump = &dev->persist->crdump;
 | |
| 	struct pci_dev *pdev = dev->persist->pdev;
 | |
| 	unsigned long cr_res_size;
 | |
| 	u8 __iomem *cr_space;
 | |
| 	int err;
 | |
| 	u32 id;
 | |
| 
 | |
| 	if (!dev->caps.health_buffer_addrs) {
 | |
| 		mlx4_info(dev, "crdump: FW doesn't support health buffer access, skipping\n");
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	if (!crdump->snapshot_enable) {
 | |
| 		mlx4_info(dev, "crdump: devlink snapshot disabled, skipping\n");
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	cr_res_size = pci_resource_len(pdev, 0);
 | |
| 
 | |
| 	cr_space = ioremap(pci_resource_start(pdev, 0), cr_res_size);
 | |
| 	if (!cr_space) {
 | |
| 		mlx4_err(dev, "crdump: Failed to map pci cr region\n");
 | |
| 		return -ENODEV;
 | |
| 	}
 | |
| 
 | |
| 	/* Get the available snapshot ID for the dumps */
 | |
| 	err = devlink_region_snapshot_id_get(devlink, &id);
 | |
| 	if (err) {
 | |
| 		mlx4_err(dev, "crdump: devlink get snapshot id err %d\n", err);
 | |
| 		iounmap(cr_space);
 | |
| 		return err;
 | |
| 	}
 | |
| 
 | |
| 	crdump_enable_crspace_access(dev, cr_space);
 | |
| 
 | |
| 	/* Try to capture dumps */
 | |
| 	mlx4_crdump_collect_crspace(dev, cr_space, id);
 | |
| 	mlx4_crdump_collect_fw_health(dev, cr_space, id);
 | |
| 
 | |
| 	/* Release reference on the snapshot id */
 | |
| 	devlink_region_snapshot_id_put(devlink, id);
 | |
| 
 | |
| 	crdump_disable_crspace_access(dev, cr_space);
 | |
| 
 | |
| 	iounmap(cr_space);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int mlx4_crdump_init(struct mlx4_dev *dev)
 | |
| {
 | |
| 	struct devlink *devlink = priv_to_devlink(mlx4_priv(dev));
 | |
| 	struct mlx4_fw_crdump *crdump = &dev->persist->crdump;
 | |
| 	struct pci_dev *pdev = dev->persist->pdev;
 | |
| 
 | |
| 	crdump->snapshot_enable = false;
 | |
| 
 | |
| 	/* Create cr-space region */
 | |
| 	crdump->region_crspace =
 | |
| 		devl_region_create(devlink,
 | |
| 				   ®ion_cr_space_ops,
 | |
| 				   MAX_NUM_OF_DUMPS_TO_STORE,
 | |
| 				   pci_resource_len(pdev, 0));
 | |
| 	if (IS_ERR(crdump->region_crspace))
 | |
| 		mlx4_warn(dev, "crdump: create devlink region %s err %ld\n",
 | |
| 			  region_cr_space_str,
 | |
| 			  PTR_ERR(crdump->region_crspace));
 | |
| 
 | |
| 	/* Create fw-health region */
 | |
| 	crdump->region_fw_health =
 | |
| 		devl_region_create(devlink,
 | |
| 				   ®ion_fw_health_ops,
 | |
| 				   MAX_NUM_OF_DUMPS_TO_STORE,
 | |
| 				   HEALTH_BUFFER_SIZE);
 | |
| 	if (IS_ERR(crdump->region_fw_health))
 | |
| 		mlx4_warn(dev, "crdump: create devlink region %s err %ld\n",
 | |
| 			  region_fw_health_str,
 | |
| 			  PTR_ERR(crdump->region_fw_health));
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| void mlx4_crdump_end(struct mlx4_dev *dev)
 | |
| {
 | |
| 	struct mlx4_fw_crdump *crdump = &dev->persist->crdump;
 | |
| 
 | |
| 	devl_region_destroy(crdump->region_fw_health);
 | |
| 	devl_region_destroy(crdump->region_crspace);
 | |
| }
 |