PCI: aerdrv: rework aer_isr_one_error()

Divide tricky for-loop into readable if-blocks.

The logic to set multi_error_valid (to force walking pci bus
hierarchy to find 2nd~ error devices) is changed too, to check
MULTI_{,_UN}COR_RCV bit individually and to force walk only when
it is required.

And rework setting e_info->severity for uncorrectable, not to use
magic numbers.

Signed-off-by: Hidetoshi Seto <seto.hidetoshi@jp.fujitsu.com>
Reviewed-by: Kenji Kaneshige <kaneshige.kenji@jp.fujitsu.com>
Signed-off-by: Jesse Barnes <jbarnes@virtuousgeek.org>

diff --git a/drivers/pci/pcie/aer/aerdrv_core.c b/drivers/pci/pcie/aer/aerdrv_core.c
index f5eb69f532e7584a400a4c918b5f4c69a98e2a93..ca140580199cf72a031856e19d67a7cfa630768e 100644 (file)
--- a/drivers/pci/pcie/aer/aerdrv_core.c
+++ b/drivers/pci/pcie/aer/aerdrv_core.c
@@ -208,6 +208,9 @@ static int find_device_iter(struct pci_dev *dev, void *data)
  * Return true if found.
  *
  * Invoked by DPC when error is detected at the Root Port.
+ * Caller of this function must set id, severity, and multi_error_valid of
+ * struct aer_err_info pointed by @e_info properly.  This function must fill
+ * e_info->error_dev_num and e_info->dev[], based on the given information.
  */
 static bool find_source_device(struct pci_dev *parent,
                struct aer_err_info *e_info)
@@ -215,6 +218,9 @@ static bool find_source_device(struct pci_dev *parent,
        struct pci_dev *dev = parent;
        int result;
 
+       /* Must reset in this function */
+       e_info->error_dev_num = 0;
+
        /* Is Root Port an agent that sends error message? */
        result = find_device_iter(dev, e_info);
        if (result)
@@ -580,11 +586,14 @@ static struct aer_err_source *get_e_source(struct aer_rpc *rpc)
  * @info: pointer to structure to store the error record
  *
  * Return 1 on success, 0 on error.
+ *
+ * Note that @info is reused among all error devices. Clear fields properly.
  */
 static int get_device_error_info(struct pci_dev *dev, struct aer_err_info *info)
 {
        int pos, temp;
 
+       /* Must reset in this function */
        info->status = 0;
        info->tlp_header_valid = 0;
 
@@ -657,11 +666,10 @@ static void aer_isr_one_error(struct pcie_device *p_device,
                struct aer_err_source *e_src)
 {
        struct aer_err_info *e_info;
-       int i;
 
        /* struct aer_err_info might be big, so we allocate it with slab */
        e_info = kmalloc(sizeof(struct aer_err_info), GFP_KERNEL);
-       if (e_info == NULL) {
+       if (!e_info) {
                dev_printk(KERN_DEBUG, &p_device->port->dev,
                        "Can't allocate mem when processing AER errors\n");
                return;
@@ -671,26 +679,33 @@ static void aer_isr_one_error(struct pcie_device *p_device,
         * There is a possibility that both correctable error and
         * uncorrectable error being logged. Report correctable error first.
         */
-       for (i = 1; i & ROOT_ERR_STATUS_MASKS ; i <<= 2) {
-               if (i > 4)
-                       break;
-               if (!(e_src->status & i))
-                       continue;
-
-               memset(e_info, 0, sizeof(struct aer_err_info));
-
-               /* Init comprehensive error information */
-               if (i & PCI_ERR_ROOT_COR_RCV) {
-                       e_info->id = ERR_COR_ID(e_src->id);
-                       e_info->severity = AER_CORRECTABLE;
-               } else {
-                       e_info->id = ERR_UNCOR_ID(e_src->id);
-                       e_info->severity = ((e_src->status >> 6) & 1);
-               }
-               if (e_src->status &
-                       (PCI_ERR_ROOT_MULTI_COR_RCV |
-                        PCI_ERR_ROOT_MULTI_UNCOR_RCV))
+       if (e_src->status & PCI_ERR_ROOT_COR_RCV) {
+               e_info->id = ERR_COR_ID(e_src->id);
+               e_info->severity = AER_CORRECTABLE;
+
+               if (e_src->status & PCI_ERR_ROOT_MULTI_COR_RCV)
+                       e_info->multi_error_valid = 1;
+               else
+                       e_info->multi_error_valid = 0;
+
+               aer_print_port_info(p_device->port, e_info);
+
+               if (find_source_device(p_device->port, e_info))
+                       aer_process_err_devices(p_device, e_info);
+       }
+
+       if (e_src->status & PCI_ERR_ROOT_UNCOR_RCV) {
+               e_info->id = ERR_UNCOR_ID(e_src->id);
+
+               if (e_src->status & PCI_ERR_ROOT_FATAL_RCV)
+                       e_info->severity = AER_FATAL;
+               else
+                       e_info->severity = AER_NONFATAL;
+
+               if (e_src->status & PCI_ERR_ROOT_MULTI_UNCOR_RCV)
                        e_info->multi_error_valid = 1;
+               else
+                       e_info->multi_error_valid = 0;
 
                aer_print_port_info(p_device->port, e_info);