iwlwifi: yoyo: use hweight_long instead of bit manipulating

Also we can only have one fid1 or fid2 set so no need to check
if the fid2 is set in case fid1 wasn't set.

Signed-off-by: Mordechay Goodstein <mordechay.goodstein@intel.com>
Signed-off-by: Luca Coelho <luciano.coelho@intel.com>
Link: https://lore.kernel.org/r/iwlwifi.20200424182644.34e74106bad3.Ic3a9f0a35fed47b02ebcd27c2dc2b50cb1e56bdf@changeid

diff --git a/drivers/net/wireless/intel/iwlwifi/fw/dbg.c b/drivers/net/wireless/intel/iwlwifi/fw/dbg.c
index 914f0eb..37c8b6c 100644 (file)
--- a/drivers/net/wireless/intel/iwlwifi/fw/dbg.c
+++ b/drivers/net/wireless/intel/iwlwifi/fw/dbg.c
@@ -1367,28 +1367,30 @@ static void iwl_ini_get_rxf_data(struct iwl_fw_runtime *fwrt,
        struct iwl_fw_ini_region_tlv *reg = (void *)reg_data->reg_tlv->data;
        u32 fid1 = le32_to_cpu(reg->fifos.fid[0]);
        u32 fid2 = le32_to_cpu(reg->fifos.fid[1]);
-       u32 fifo_idx;
+       u8 fifo_idx;
 
        if (!data)
                return;
 
+       /* make sure only one bit is set in only one fid */
+       if (WARN_ONCE(hweight_long(fid1) + hweight_long(fid2) != 1,
+                     "fid1=%x, fid2=%x\n", fid1, fid2))
+               return;
+
        memset(data, 0, sizeof(*data));
 
-       if (WARN_ON_ONCE((fid1 && fid2) || (!fid1 && !fid2)))
-               return;
+       if (fid1) {
+               fifo_idx = ffs(fid1) - 1;
+               if (WARN_ONCE(fifo_idx >= MAX_NUM_LMAC, "fifo_idx=%d\n",
+                             fifo_idx))
+                       return;
 
-       fifo_idx = ffs(fid1) - 1;
-       if (fid1 && !WARN_ON_ONCE((~BIT(fifo_idx) & fid1) ||
-                                 fifo_idx >= MAX_NUM_LMAC)) {
                data->size = fwrt->smem_cfg.lmac[fifo_idx].rxfifo1_size;
                data->fifo_num = fifo_idx;
-               return;
-       }
-
-       fifo_idx = ffs(fid2) - 1;
-       if (fid2 && !WARN_ON_ONCE(~BIT(fifo_idx) & fid2)) {
+       } else {
                u8 max_idx;
 
+               fifo_idx = ffs(fid2) - 1;
                if (iwl_fw_lookup_notif_ver(fwrt->fw, SYSTEM_GROUP,
                                            SHARED_MEM_CFG_CMD, 0) <= 3)
                        max_idx = 0;
@@ -1416,7 +1418,6 @@ static void iwl_ini_get_rxf_data(struct iwl_fw_runtime *fwrt,
                                                     RXF2C_DIFF_FROM_PREV);
                        break;
                }
-               return;
        }
 }