The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/dev/mps/mps_mapping.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    1 /*-
    2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
    3  *
    4  * Copyright (c) 2011-2015 LSI Corp.
    5  * Copyright (c) 2013-2015 Avago Technologies
    6  * All rights reserved.
    7  *
    8  * Redistribution and use in source and binary forms, with or without
    9  * modification, are permitted provided that the following conditions
   10  * are met:
   11  * 1. Redistributions of source code must retain the above copyright
   12  *    notice, this list of conditions and the following disclaimer.
   13  * 2. Redistributions in binary form must reproduce the above copyright
   14  *    notice, this list of conditions and the following disclaimer in the
   15  *    documentation and/or other materials provided with the distribution.
   16  *
   17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
   18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
   19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
   20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
   21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
   22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
   23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
   24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
   25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
   26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
   27  * SUCH DAMAGE.
   28  *
   29  * Avago Technologies (LSI) MPT-Fusion Host Adapter FreeBSD
   30  */
   31 
   32 #include <sys/cdefs.h>
   33 __FBSDID("$FreeBSD$");
   34 
   35 /* TODO Move headers to mpsvar */
   36 #include <sys/types.h>
   37 #include <sys/param.h>
   38 #include <sys/lock.h>
   39 #include <sys/mutex.h>
   40 #include <sys/systm.h>
   41 #include <sys/kernel.h>
   42 #include <sys/malloc.h>
   43 #include <sys/kthread.h>
   44 #include <sys/taskqueue.h>
   45 #include <sys/bus.h>
   46 #include <sys/endian.h>
   47 #include <sys/sysctl.h>
   48 #include <sys/sbuf.h>
   49 #include <sys/eventhandler.h>
   50 #include <sys/uio.h>
   51 #include <machine/bus.h>
   52 #include <machine/resource.h>
   53 #include <dev/mps/mpi/mpi2_type.h>
   54 #include <dev/mps/mpi/mpi2.h>
   55 #include <dev/mps/mpi/mpi2_ioc.h>
   56 #include <dev/mps/mpi/mpi2_sas.h>
   57 #include <dev/mps/mpi/mpi2_cnfg.h>
   58 #include <dev/mps/mpi/mpi2_init.h>
   59 #include <dev/mps/mpi/mpi2_tool.h>
   60 #include <dev/mps/mps_ioctl.h>
   61 #include <dev/mps/mpsvar.h>
   62 #include <dev/mps/mps_mapping.h>
   63 
   64 /**
   65  * _mapping_clear_map_entry - Clear a particular mapping entry.
   66  * @map_entry: map table entry
   67  *
   68  * Returns nothing.
   69  */
   70 static inline void
   71 _mapping_clear_map_entry(struct dev_mapping_table *map_entry)
   72 {
   73         map_entry->physical_id = 0;
   74         map_entry->device_info = 0;
   75         map_entry->phy_bits = 0;
   76         map_entry->dpm_entry_num = MPS_DPM_BAD_IDX;
   77         map_entry->dev_handle = 0;
   78         map_entry->id = -1;
   79         map_entry->missing_count = 0;
   80         map_entry->init_complete = 0;
   81         map_entry->TLR_bits = (u8)MPI2_SCSIIO_CONTROL_NO_TLR;
   82 }
   83 
   84 /**
   85  * _mapping_clear_enc_entry - Clear a particular enclosure table entry.
   86  * @enc_entry: enclosure table entry
   87  *
   88  * Returns nothing.
   89  */
   90 static inline void
   91 _mapping_clear_enc_entry(struct enc_mapping_table *enc_entry)
   92 {
   93         enc_entry->enclosure_id = 0;
   94         enc_entry->start_index = MPS_MAPTABLE_BAD_IDX;
   95         enc_entry->phy_bits = 0;
   96         enc_entry->dpm_entry_num = MPS_DPM_BAD_IDX;
   97         enc_entry->enc_handle = 0;
   98         enc_entry->num_slots = 0;
   99         enc_entry->start_slot = 0;
  100         enc_entry->missing_count = 0;
  101         enc_entry->removal_flag = 0;
  102         enc_entry->skip_search = 0;
  103         enc_entry->init_complete = 0;
  104 }
  105 
  106 /**
  107  * _mapping_commit_enc_entry - write a particular enc entry in DPM page0.
  108  * @sc: per adapter object
  109  * @enc_entry: enclosure table entry
  110  *
  111  * Returns 0 for success, non-zero for failure.
  112  */
  113 static int
  114 _mapping_commit_enc_entry(struct mps_softc *sc,
  115     struct enc_mapping_table *et_entry)
  116 {
  117         Mpi2DriverMap0Entry_t *dpm_entry;
  118         struct dev_mapping_table *mt_entry;
  119         Mpi2ConfigReply_t mpi_reply;
  120         Mpi2DriverMappingPage0_t config_page;
  121 
  122         if (!sc->is_dpm_enable)
  123                 return 0;
  124 
  125         memset(&config_page, 0, sizeof(Mpi2DriverMappingPage0_t));
  126         memcpy(&config_page.Header, (u8 *) sc->dpm_pg0,
  127             sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
  128         dpm_entry = (Mpi2DriverMap0Entry_t *)((u8 *)sc->dpm_pg0 +
  129             sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
  130         dpm_entry += et_entry->dpm_entry_num;
  131         dpm_entry->PhysicalIdentifier.Low =
  132             ( 0xFFFFFFFF & et_entry->enclosure_id);
  133         dpm_entry->PhysicalIdentifier.High =
  134             ( et_entry->enclosure_id >> 32);
  135         mt_entry = &sc->mapping_table[et_entry->start_index];
  136         dpm_entry->DeviceIndex = htole16(mt_entry->id);
  137         dpm_entry->MappingInformation = et_entry->num_slots;
  138         dpm_entry->MappingInformation <<= MPI2_DRVMAP0_MAPINFO_SLOT_SHIFT;
  139         dpm_entry->MappingInformation |= et_entry->missing_count;
  140         dpm_entry->MappingInformation = htole16(dpm_entry->MappingInformation);
  141         dpm_entry->PhysicalBitsMapping = htole32(et_entry->phy_bits);
  142         dpm_entry->Reserved1 = 0;
  143 
  144         mps_dprint(sc, MPS_MAPPING, "%s: Writing DPM entry %d for enclosure.\n",
  145             __func__, et_entry->dpm_entry_num);
  146         memcpy(&config_page.Entry, (u8 *)dpm_entry,
  147             sizeof(Mpi2DriverMap0Entry_t));
  148         if (mps_config_set_dpm_pg0(sc, &mpi_reply, &config_page,
  149             et_entry->dpm_entry_num)) {
  150                 mps_dprint(sc, MPS_ERROR | MPS_MAPPING, "%s: Write of DPM "
  151                     "entry %d for enclosure failed.\n", __func__,
  152                     et_entry->dpm_entry_num);
  153                 dpm_entry->MappingInformation = le16toh(dpm_entry->
  154                     MappingInformation);
  155                 dpm_entry->DeviceIndex = le16toh(dpm_entry->DeviceIndex);
  156                 dpm_entry->PhysicalBitsMapping =
  157                     le32toh(dpm_entry->PhysicalBitsMapping);
  158                 return -1;
  159         }
  160         dpm_entry->MappingInformation = le16toh(dpm_entry->
  161             MappingInformation);
  162         dpm_entry->DeviceIndex = le16toh(dpm_entry->DeviceIndex);
  163         dpm_entry->PhysicalBitsMapping =
  164             le32toh(dpm_entry->PhysicalBitsMapping);
  165         return 0;
  166 }
  167 
  168 /**
  169  * _mapping_commit_map_entry - write a particular map table entry in DPM page0.
  170  * @sc: per adapter object
  171  * @mt_entry: mapping table entry
  172  *
  173  * Returns 0 for success, non-zero for failure.
  174  */
  175 
  176 static int
  177 _mapping_commit_map_entry(struct mps_softc *sc,
  178     struct dev_mapping_table *mt_entry)
  179 {
  180         Mpi2DriverMap0Entry_t *dpm_entry;
  181         Mpi2ConfigReply_t mpi_reply;
  182         Mpi2DriverMappingPage0_t config_page;
  183 
  184         if (!sc->is_dpm_enable)
  185                 return 0;
  186 
  187         /*
  188          * It's possible that this Map Entry points to a BAD DPM index. This
  189          * can happen if the Map Entry is a for a missing device and the DPM
  190          * entry that was being used by this device is now being used by some
  191          * new device. So, check for a BAD DPM index and just return if so.
  192          */
  193         if (mt_entry->dpm_entry_num == MPS_DPM_BAD_IDX) {
  194                 mps_dprint(sc, MPS_MAPPING, "%s: DPM entry location for target "
  195                     "%d is invalid. DPM will not be written.\n", __func__,
  196                     mt_entry->id);
  197                 return 0;
  198         }
  199 
  200         memset(&config_page, 0, sizeof(Mpi2DriverMappingPage0_t));
  201         memcpy(&config_page.Header, (u8 *)sc->dpm_pg0,
  202             sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
  203         dpm_entry = (Mpi2DriverMap0Entry_t *)((u8 *) sc->dpm_pg0 +
  204             sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
  205         dpm_entry = dpm_entry + mt_entry->dpm_entry_num;
  206         dpm_entry->PhysicalIdentifier.Low = (0xFFFFFFFF &
  207             mt_entry->physical_id);
  208         dpm_entry->PhysicalIdentifier.High = (mt_entry->physical_id >> 32);
  209         dpm_entry->DeviceIndex = htole16(mt_entry->id);
  210         dpm_entry->MappingInformation = htole16(mt_entry->missing_count);
  211         dpm_entry->PhysicalBitsMapping = 0;
  212         dpm_entry->Reserved1 = 0;
  213         memcpy(&config_page.Entry, (u8 *)dpm_entry,
  214             sizeof(Mpi2DriverMap0Entry_t));
  215 
  216         mps_dprint(sc, MPS_MAPPING, "%s: Writing DPM entry %d for target %d.\n",
  217             __func__, mt_entry->dpm_entry_num, mt_entry->id);
  218         if (mps_config_set_dpm_pg0(sc, &mpi_reply, &config_page,
  219             mt_entry->dpm_entry_num)) {
  220                 mps_dprint(sc, MPS_ERROR | MPS_MAPPING, "%s: Write of DPM "
  221                     "entry %d for target %d failed.\n", __func__,
  222                     mt_entry->dpm_entry_num, mt_entry->id);
  223                 dpm_entry->MappingInformation = le16toh(dpm_entry->
  224                     MappingInformation);
  225                 dpm_entry->DeviceIndex = le16toh(dpm_entry->DeviceIndex);
  226                 return -1;
  227         }
  228 
  229         dpm_entry->MappingInformation = le16toh(dpm_entry->MappingInformation);
  230         dpm_entry->DeviceIndex = le16toh(dpm_entry->DeviceIndex);
  231         return 0;
  232 }
  233 
  234 /**
  235  * _mapping_get_ir_maprange - get start and end index for IR map range.
  236  * @sc: per adapter object
  237  * @start_idx: place holder for start index
  238  * @end_idx: place holder for end index
  239  *
  240  * The IR volumes can be mapped either at start or end of the mapping table
  241  * this function gets the detail of where IR volume mapping starts and ends
  242  * in the device mapping table
  243  *
  244  * Returns nothing.
  245  */
  246 static void
  247 _mapping_get_ir_maprange(struct mps_softc *sc, u32 *start_idx, u32 *end_idx)
  248 {
  249         u16 volume_mapping_flags;
  250         u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags);
  251 
  252         volume_mapping_flags = le16toh(sc->ioc_pg8.IRVolumeMappingFlags) &
  253             MPI2_IOCPAGE8_IRFLAGS_MASK_VOLUME_MAPPING_MODE;
  254         if (volume_mapping_flags == MPI2_IOCPAGE8_IRFLAGS_LOW_VOLUME_MAPPING) {
  255                 *start_idx = 0;
  256                 if (ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_RESERVED_TARGETID_0)
  257                         *start_idx = 1;
  258         } else
  259                 *start_idx = sc->max_devices - sc->max_volumes;
  260         *end_idx = *start_idx + sc->max_volumes - 1;
  261 }
  262 
  263 /**
  264  * _mapping_get_enc_idx_from_id - get enclosure index from enclosure ID
  265  * @sc: per adapter object
  266  * @enc_id: enclosure logical identifier
  267  *
  268  * Returns the index of enclosure entry on success or bad index.
  269  */
  270 static u8
  271 _mapping_get_enc_idx_from_id(struct mps_softc *sc, u64 enc_id,
  272     u64 phy_bits)
  273 {
  274         struct enc_mapping_table *et_entry;
  275         u8 enc_idx = 0;
  276 
  277         for (enc_idx = 0; enc_idx < sc->num_enc_table_entries; enc_idx++) {
  278                 et_entry = &sc->enclosure_table[enc_idx];
  279                 if ((et_entry->enclosure_id == le64toh(enc_id)) &&
  280                     (!et_entry->phy_bits || (et_entry->phy_bits &
  281                     le32toh(phy_bits))))
  282                         return enc_idx;
  283         }
  284         return MPS_ENCTABLE_BAD_IDX;
  285 }
  286 
  287 /**
  288  * _mapping_get_enc_idx_from_handle - get enclosure index from handle
  289  * @sc: per adapter object
  290  * @enc_id: enclosure handle
  291  *
  292  * Returns the index of enclosure entry on success or bad index.
  293  */
  294 static u8
  295 _mapping_get_enc_idx_from_handle(struct mps_softc *sc, u16 handle)
  296 {
  297         struct enc_mapping_table *et_entry;
  298         u8 enc_idx = 0;
  299 
  300         for (enc_idx = 0; enc_idx < sc->num_enc_table_entries; enc_idx++) {
  301                 et_entry = &sc->enclosure_table[enc_idx];
  302                 if (et_entry->missing_count)
  303                         continue;
  304                 if (et_entry->enc_handle == handle)
  305                         return enc_idx;
  306         }
  307         return MPS_ENCTABLE_BAD_IDX;
  308 }
  309 
  310 /**
  311  * _mapping_get_high_missing_et_idx - get missing enclosure index
  312  * @sc: per adapter object
  313  *
  314  * Search through the enclosure table and identifies the enclosure entry
  315  * with high missing count and returns it's index
  316  *
  317  * Returns the index of enclosure entry on success or bad index.
  318  */
  319 static u8
  320 _mapping_get_high_missing_et_idx(struct mps_softc *sc)
  321 {
  322         struct enc_mapping_table *et_entry;
  323         u8 high_missing_count = 0;
  324         u8 enc_idx, high_idx = MPS_ENCTABLE_BAD_IDX;
  325 
  326         for (enc_idx = 0; enc_idx < sc->num_enc_table_entries; enc_idx++) {
  327                 et_entry = &sc->enclosure_table[enc_idx];
  328                 if ((et_entry->missing_count > high_missing_count) &&
  329                     !et_entry->skip_search) {
  330                         high_missing_count = et_entry->missing_count;
  331                         high_idx = enc_idx;
  332                 }
  333         }
  334         return high_idx;
  335 }
  336 
  337 /**
  338  * _mapping_get_high_missing_mt_idx - get missing map table index
  339  * @sc: per adapter object
  340  *
  341  * Search through the map table and identifies the device entry
  342  * with high missing count and returns it's index
  343  *
  344  * Returns the index of map table entry on success or bad index.
  345  */
  346 static u32
  347 _mapping_get_high_missing_mt_idx(struct mps_softc *sc)
  348 {
  349         u32 map_idx, high_idx = MPS_MAPTABLE_BAD_IDX;
  350         u8 high_missing_count = 0;
  351         u32 start_idx, end_idx, start_idx_ir, end_idx_ir;
  352         struct dev_mapping_table *mt_entry;
  353         u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags);
  354 
  355         start_idx = 0;
  356         start_idx_ir = 0;
  357         end_idx_ir = 0;
  358         end_idx = sc->max_devices;
  359         if (ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_RESERVED_TARGETID_0)
  360                 start_idx = 1;
  361         if (sc->ir_firmware) {
  362                 _mapping_get_ir_maprange(sc, &start_idx_ir, &end_idx_ir);
  363                 if (start_idx == start_idx_ir)
  364                         start_idx = end_idx_ir + 1;
  365                 else
  366                         end_idx = start_idx_ir;
  367         }
  368         mt_entry = &sc->mapping_table[start_idx];
  369         for (map_idx = start_idx; map_idx < end_idx; map_idx++, mt_entry++) {
  370                 if (mt_entry->missing_count > high_missing_count) {
  371                         high_missing_count =  mt_entry->missing_count;
  372                         high_idx = map_idx;
  373                 }
  374         }
  375         return high_idx;
  376 }
  377 
  378 /**
  379  * _mapping_get_ir_mt_idx_from_wwid - get map table index from volume WWID
  380  * @sc: per adapter object
  381  * @wwid: world wide unique ID of the volume
  382  *
  383  * Returns the index of map table entry on success or bad index.
  384  */
  385 static u32
  386 _mapping_get_ir_mt_idx_from_wwid(struct mps_softc *sc, u64 wwid)
  387 {
  388         u32 start_idx, end_idx, map_idx;
  389         struct dev_mapping_table *mt_entry;
  390 
  391         _mapping_get_ir_maprange(sc, &start_idx, &end_idx);
  392         mt_entry = &sc->mapping_table[start_idx];
  393         for (map_idx = start_idx; map_idx <= end_idx; map_idx++, mt_entry++)
  394                 if (mt_entry->physical_id == wwid)
  395                         return map_idx;
  396 
  397         return MPS_MAPTABLE_BAD_IDX;
  398 }
  399 
  400 /**
  401  * _mapping_get_mt_idx_from_id - get map table index from a device ID
  402  * @sc: per adapter object
  403  * @dev_id: device identifer (SAS Address)
  404  *
  405  * Returns the index of map table entry on success or bad index.
  406  */
  407 static u32
  408 _mapping_get_mt_idx_from_id(struct mps_softc *sc, u64 dev_id)
  409 {
  410         u32 map_idx;
  411         struct dev_mapping_table *mt_entry;
  412 
  413         for (map_idx = 0; map_idx < sc->max_devices; map_idx++) {
  414                 mt_entry = &sc->mapping_table[map_idx];
  415                 if (mt_entry->physical_id == dev_id)
  416                         return map_idx;
  417         }
  418         return MPS_MAPTABLE_BAD_IDX;
  419 }
  420 
  421 /**
  422  * _mapping_get_ir_mt_idx_from_handle - get map table index from volume handle
  423  * @sc: per adapter object
  424  * @wwid: volume device handle
  425  *
  426  * Returns the index of map table entry on success or bad index.
  427  */
  428 static u32
  429 _mapping_get_ir_mt_idx_from_handle(struct mps_softc *sc, u16 volHandle)
  430 {
  431         u32 start_idx, end_idx, map_idx;
  432         struct dev_mapping_table *mt_entry;
  433 
  434         _mapping_get_ir_maprange(sc, &start_idx, &end_idx);
  435         mt_entry = &sc->mapping_table[start_idx];
  436         for (map_idx = start_idx; map_idx <= end_idx; map_idx++, mt_entry++)
  437                 if (mt_entry->dev_handle == volHandle)
  438                         return map_idx;
  439 
  440         return MPS_MAPTABLE_BAD_IDX;
  441 }
  442 
  443 /**
  444  * _mapping_get_mt_idx_from_handle - get map table index from handle
  445  * @sc: per adapter object
  446  * @dev_id: device handle
  447  *
  448  * Returns the index of map table entry on success or bad index.
  449  */
  450 static u32
  451 _mapping_get_mt_idx_from_handle(struct mps_softc *sc, u16 handle)
  452 {
  453         u32 map_idx;
  454         struct dev_mapping_table *mt_entry;
  455 
  456         for (map_idx = 0; map_idx < sc->max_devices; map_idx++) {
  457                 mt_entry = &sc->mapping_table[map_idx];
  458                 if (mt_entry->dev_handle == handle)
  459                         return map_idx;
  460         }
  461         return MPS_MAPTABLE_BAD_IDX;
  462 }
  463 
  464 /**
  465  * _mapping_get_free_ir_mt_idx - get first free index for a volume
  466  * @sc: per adapter object
  467  *
  468  * Search through mapping table for free index for a volume and if no free
  469  * index then looks for a volume with high mapping index
  470  *
  471  * Returns the index of map table entry on success or bad index.
  472  */
  473 static u32
  474 _mapping_get_free_ir_mt_idx(struct mps_softc *sc)
  475 {
  476         u8 high_missing_count = 0;
  477         u32 start_idx, end_idx, map_idx;
  478         u32 high_idx = MPS_MAPTABLE_BAD_IDX;
  479         struct dev_mapping_table *mt_entry;
  480 
  481         /*
  482          * The IN_USE flag should be clear if the entry is available to use.
  483          * This flag is cleared on initialization and and when a volume is
  484          * deleted. All other times this flag should be set. If, for some
  485          * reason, a free entry cannot be found, look for the entry with the
  486          * highest missing count just in case there is one.
  487          */
  488         _mapping_get_ir_maprange(sc, &start_idx, &end_idx);
  489 
  490         mt_entry = &sc->mapping_table[start_idx];
  491         for (map_idx = start_idx; map_idx <= end_idx; map_idx++, mt_entry++) {
  492                 if (!(mt_entry->device_info & MPS_MAP_IN_USE))
  493                         return map_idx;
  494 
  495                 if (mt_entry->missing_count > high_missing_count) {
  496                         high_missing_count = mt_entry->missing_count;
  497                         high_idx = map_idx;
  498                 }
  499         }
  500 
  501         if (high_idx == MPS_MAPTABLE_BAD_IDX) {
  502                 mps_dprint(sc, MPS_ERROR | MPS_MAPPING, "%s: Could not find a "
  503                     "free entry in the mapping table for a Volume. The mapping "
  504                     "table is probably corrupt.\n", __func__);
  505         }
  506 
  507         return high_idx;
  508 }
  509 
  510 /**
  511  * _mapping_get_free_mt_idx - get first free index for a device
  512  * @sc: per adapter object
  513  * @start_idx: offset in the table to start search
  514  *
  515  * Returns the index of map table entry on success or bad index.
  516  */
  517 static u32
  518 _mapping_get_free_mt_idx(struct mps_softc *sc, u32 start_idx)
  519 {
  520         u32 map_idx, max_idx = sc->max_devices;
  521         struct dev_mapping_table *mt_entry = &sc->mapping_table[start_idx];
  522         u16 volume_mapping_flags;
  523 
  524         volume_mapping_flags = le16toh(sc->ioc_pg8.IRVolumeMappingFlags) &
  525             MPI2_IOCPAGE8_IRFLAGS_MASK_VOLUME_MAPPING_MODE;
  526         if (sc->ir_firmware && (volume_mapping_flags ==
  527             MPI2_IOCPAGE8_IRFLAGS_HIGH_VOLUME_MAPPING))
  528                 max_idx -= sc->max_volumes;
  529 
  530         for (map_idx  = start_idx; map_idx < max_idx; map_idx++, mt_entry++)
  531                 if (!(mt_entry->device_info & (MPS_MAP_IN_USE |
  532                     MPS_DEV_RESERVED)))
  533                         return map_idx;
  534 
  535         return MPS_MAPTABLE_BAD_IDX;
  536 }
  537 
  538 /**
  539  * _mapping_get_dpm_idx_from_id - get DPM index from ID
  540  * @sc: per adapter object
  541  * @id: volume WWID or enclosure ID or device ID
  542  *
  543  * Returns the index of DPM entry on success or bad index.
  544  */
  545 static u16
  546 _mapping_get_dpm_idx_from_id(struct mps_softc *sc, u64 id, u32 phy_bits)
  547 {
  548         u16 entry_num;
  549         uint64_t PhysicalIdentifier;
  550         Mpi2DriverMap0Entry_t *dpm_entry;
  551 
  552         dpm_entry = (Mpi2DriverMap0Entry_t *)((u8 *)sc->dpm_pg0 +
  553             sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
  554         PhysicalIdentifier = dpm_entry->PhysicalIdentifier.High;
  555         PhysicalIdentifier = (PhysicalIdentifier << 32) | 
  556             dpm_entry->PhysicalIdentifier.Low;
  557         for (entry_num = 0; entry_num < sc->max_dpm_entries; entry_num++,
  558             dpm_entry++)
  559                 if ((id == PhysicalIdentifier) &&
  560                     (!phy_bits || !dpm_entry->PhysicalBitsMapping ||
  561                     (phy_bits & dpm_entry->PhysicalBitsMapping)))
  562                         return entry_num;
  563 
  564         return MPS_DPM_BAD_IDX;
  565 }
  566 
  567 /**
  568  * _mapping_get_free_dpm_idx - get first available DPM index
  569  * @sc: per adapter object
  570  *
  571  * Returns the index of DPM entry on success or bad index.
  572  */
  573 static u32
  574 _mapping_get_free_dpm_idx(struct mps_softc *sc)
  575 {
  576         u16 entry_num;
  577         Mpi2DriverMap0Entry_t *dpm_entry;
  578         u16 current_entry = MPS_DPM_BAD_IDX, missing_cnt, high_missing_cnt = 0;
  579         u64 physical_id;
  580         struct dev_mapping_table *mt_entry;
  581         u32 map_idx;
  582 
  583         for (entry_num = 0; entry_num < sc->max_dpm_entries; entry_num++) {
  584                 dpm_entry = (Mpi2DriverMap0Entry_t *) ((u8 *)sc->dpm_pg0 +
  585                     sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
  586                 dpm_entry += entry_num;
  587                 missing_cnt = dpm_entry->MappingInformation &
  588                     MPI2_DRVMAP0_MAPINFO_MISSING_MASK;
  589 
  590                 /*
  591                  * If entry is used and not missing, then this entry can't be
  592                  * used. Look at next one.
  593                  */
  594                 if (sc->dpm_entry_used[entry_num] && !missing_cnt)
  595                         continue;
  596 
  597                 /*
  598                  * If this entry is not used at all, then the missing count
  599                  * doesn't matter. Just use this one. Otherwise, keep looking
  600                  * and make sure the entry with the highest missing count is
  601                  * used.
  602                  */
  603                 if (!sc->dpm_entry_used[entry_num]) {
  604                         current_entry = entry_num;
  605                         break;
  606                 }
  607                 if ((current_entry == MPS_DPM_BAD_IDX) ||
  608                     (missing_cnt > high_missing_cnt)) {
  609                         current_entry = entry_num;
  610                         high_missing_cnt = missing_cnt;
  611                 }
  612         }
  613 
  614         /*
  615          * If an entry has been found to use and it's already marked as used
  616          * it means that some device was already using this entry but it's
  617          * missing, and that means that the connection between the missing
  618          * device's DPM entry and the mapping table needs to be cleared. To do
  619          * this, use the Physical ID of the old device still in the DPM entry
  620          * to find its mapping table entry, then mark its DPM entry as BAD.
  621          */
  622         if ((current_entry != MPS_DPM_BAD_IDX) &&
  623             sc->dpm_entry_used[current_entry]) {
  624                 dpm_entry = (Mpi2DriverMap0Entry_t *) ((u8 *)sc->dpm_pg0 +
  625                     sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
  626                 dpm_entry += current_entry;
  627                 physical_id = dpm_entry->PhysicalIdentifier.High;
  628                 physical_id = (physical_id << 32) |
  629                     dpm_entry->PhysicalIdentifier.Low;
  630                 map_idx = _mapping_get_mt_idx_from_id(sc, physical_id);
  631                 if (map_idx != MPS_MAPTABLE_BAD_IDX) {
  632                         mt_entry = &sc->mapping_table[map_idx];
  633                         mt_entry->dpm_entry_num = MPS_DPM_BAD_IDX;
  634                 }
  635         }
  636         return current_entry;
  637 }
  638 
  639 /**
  640  * _mapping_update_ir_missing_cnt - Updates missing count for a volume
  641  * @sc: per adapter object
  642  * @map_idx: map table index of the volume
  643  * @element: IR configuration change element
  644  * @wwid: IR volume ID.
  645  *
  646  * Updates the missing count in the map table and in the DPM entry for a volume
  647  *
  648  * Returns nothing.
  649  */
  650 static void
  651 _mapping_update_ir_missing_cnt(struct mps_softc *sc, u32 map_idx,
  652     Mpi2EventIrConfigElement_t *element, u64 wwid)
  653 {
  654         struct dev_mapping_table *mt_entry;
  655         u8 missing_cnt, reason = element->ReasonCode, update_dpm = 1;
  656         u16 dpm_idx;
  657         Mpi2DriverMap0Entry_t *dpm_entry;
  658 
  659         /*
  660          * Depending on the reason code, update the missing count. Always set
  661          * the init_complete flag when here, so just do it first. That flag is
  662          * used for volumes to make sure that the DPM entry has been updated.
  663          * When a volume is deleted, clear the map entry's IN_USE flag so that
  664          * the entry can be used again if another volume is created. Also clear
  665          * its dev_handle entry so that other functions can't find this volume
  666          * by the handle, since it's not defined any longer.
  667          */
  668         mt_entry = &sc->mapping_table[map_idx];
  669         mt_entry->init_complete = 1;
  670         if ((reason == MPI2_EVENT_IR_CHANGE_RC_ADDED) ||
  671             (reason == MPI2_EVENT_IR_CHANGE_RC_VOLUME_CREATED)) {
  672                 mt_entry->missing_count = 0;
  673         } else if (reason == MPI2_EVENT_IR_CHANGE_RC_VOLUME_DELETED) {
  674                 if (mt_entry->missing_count < MPS_MAX_MISSING_COUNT)
  675                         mt_entry->missing_count++;
  676 
  677                 mt_entry->device_info &= ~MPS_MAP_IN_USE;
  678                 mt_entry->dev_handle = 0;
  679         }
  680 
  681         /*
  682          * If persistent mapping is enabled, update the DPM with the new missing
  683          * count for the volume. If the DPM index is bad, get a free one. If
  684          * it's bad for a volume that's being deleted do nothing because that
  685          * volume doesn't have a DPM entry. 
  686          */
  687         if (!sc->is_dpm_enable)
  688                 return;
  689         dpm_idx = mt_entry->dpm_entry_num;
  690         if (dpm_idx == MPS_DPM_BAD_IDX) {
  691                 if (reason == MPI2_EVENT_IR_CHANGE_RC_VOLUME_DELETED)
  692                 {
  693                         mps_dprint(sc, MPS_MAPPING, "%s: Volume being deleted "
  694                             "is not in DPM so DPM missing count will not be "
  695                             "updated.\n", __func__);
  696                         return;
  697                 }
  698         }
  699         if (dpm_idx == MPS_DPM_BAD_IDX)
  700                 dpm_idx = _mapping_get_free_dpm_idx(sc);
  701 
  702         /*
  703          * Got the DPM entry for the volume or found a free DPM entry if this is
  704          * a new volume. Check if the current information is outdated.
  705          */
  706         if (dpm_idx != MPS_DPM_BAD_IDX) {
  707                 dpm_entry = (Mpi2DriverMap0Entry_t *)((u8 *)sc->dpm_pg0 +
  708                     sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
  709                 dpm_entry += dpm_idx;
  710                 missing_cnt = dpm_entry->MappingInformation &
  711                     MPI2_DRVMAP0_MAPINFO_MISSING_MASK;
  712                 if ((mt_entry->physical_id ==
  713                     le64toh(((u64)dpm_entry->PhysicalIdentifier.High << 32) |
  714                     (u64)dpm_entry->PhysicalIdentifier.Low)) && (missing_cnt ==
  715                     mt_entry->missing_count)) {
  716                         mps_dprint(sc, MPS_MAPPING, "%s: DPM entry for volume "
  717                            "with target ID %d does not require an update.\n",
  718                             __func__, mt_entry->id);
  719                         update_dpm = 0;
  720                 }
  721         }
  722 
  723         /*
  724          * Update the volume's persistent info if it's new or the ID or missing
  725          * count has changed. If a good DPM index has not been found by now,
  726          * there is no space left in the DPM table.
  727          */
  728         if ((dpm_idx != MPS_DPM_BAD_IDX) && update_dpm) {
  729                 mps_dprint(sc, MPS_MAPPING, "%s: Update DPM entry for volume "
  730                     "with target ID %d.\n", __func__, mt_entry->id);
  731 
  732                 mt_entry->dpm_entry_num = dpm_idx;
  733                 dpm_entry = (Mpi2DriverMap0Entry_t *)((u8 *)sc->dpm_pg0 +
  734                     sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
  735                 dpm_entry += dpm_idx;
  736                 dpm_entry->PhysicalIdentifier.Low =
  737                     (0xFFFFFFFF & mt_entry->physical_id);
  738                 dpm_entry->PhysicalIdentifier.High =
  739                     (mt_entry->physical_id >> 32);
  740                 dpm_entry->DeviceIndex = map_idx;
  741                 dpm_entry->MappingInformation = mt_entry->missing_count;
  742                 dpm_entry->PhysicalBitsMapping = 0;
  743                 dpm_entry->Reserved1 = 0;
  744                 sc->dpm_flush_entry[dpm_idx] = 1;
  745                 sc->dpm_entry_used[dpm_idx] = 1;
  746         } else if (dpm_idx == MPS_DPM_BAD_IDX) {
  747                 mps_dprint(sc, MPS_INFO | MPS_MAPPING, "%s: No space to add an "
  748                     "entry in the DPM table for volume with target ID %d.\n",
  749                     __func__, mt_entry->id);
  750         }
  751 }
  752 
  753 /**
  754  * _mapping_add_to_removal_table - add DPM index to the removal table
  755  * @sc: per adapter object
  756  * @dpm_idx: Index of DPM entry to remove
  757  *
  758  * Adds a DPM entry number to the removal table.
  759  *
  760  * Returns nothing.
  761  */
  762 static void
  763 _mapping_add_to_removal_table(struct mps_softc *sc, u16 dpm_idx)
  764 {
  765         struct map_removal_table *remove_entry;
  766         u32 i;
  767 
  768         /*
  769          * This is only used to remove entries from the DPM in the controller.
  770          * If DPM is not enabled, just return.
  771          */
  772         if (!sc->is_dpm_enable)
  773                 return;
  774 
  775         /*
  776          * Find the first available removal_table entry and add the new entry
  777          * there.
  778          */
  779         remove_entry = sc->removal_table;
  780 
  781         for (i = 0; i < sc->max_devices; i++, remove_entry++) {
  782                 if (remove_entry->dpm_entry_num != MPS_DPM_BAD_IDX)
  783                         continue;
  784 
  785                 mps_dprint(sc, MPS_MAPPING, "%s: Adding DPM entry %d to table "
  786                     "for removal.\n", __func__, dpm_idx);
  787                 remove_entry->dpm_entry_num = dpm_idx;
  788                 break;
  789         }
  790 
  791 }
  792 
  793 /**
  794  * _mapping_update_missing_count - Update missing count for a device
  795  * @sc: per adapter object
  796  * @topo_change: Topology change event entry
  797  *
  798  * Increment the missing count in the mapping table for a device that is not
  799  * responding. If Persitent Mapping is used, increment the DPM entry as well.
  800  * Currently, this function only increments the missing count if the device 
  801  * goes missing, so after initialization has completed. This means that the
  802  * missing count can only go from 0 to 1 here. The missing count is incremented
  803  * during initialization as well, so that's where a target's missing count can
  804  * go past 1.
  805  *
  806  * Returns nothing.
  807  */
  808 static void
  809 _mapping_update_missing_count(struct mps_softc *sc,
  810     struct _map_topology_change *topo_change)
  811 {
  812         u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags);
  813         u8 entry;
  814         struct _map_phy_change *phy_change;
  815         u32 map_idx;
  816         struct dev_mapping_table *mt_entry;
  817         Mpi2DriverMap0Entry_t *dpm_entry;
  818 
  819         for (entry = 0; entry < topo_change->num_entries; entry++) {
  820                 phy_change = &topo_change->phy_details[entry];
  821                 if (!phy_change->dev_handle || (phy_change->reason !=
  822                     MPI2_EVENT_SAS_TOPO_RC_TARG_NOT_RESPONDING))
  823                         continue;
  824                 map_idx = _mapping_get_mt_idx_from_handle(sc, phy_change->
  825                     dev_handle);
  826                 phy_change->is_processed = 1;
  827                 if (map_idx == MPS_MAPTABLE_BAD_IDX) {
  828                         mps_dprint(sc, MPS_INFO | MPS_MAPPING, "%s: device is "
  829                             "already removed from mapping table\n", __func__);
  830                         continue;
  831                 }
  832                 mt_entry = &sc->mapping_table[map_idx];
  833                 if (mt_entry->missing_count < MPS_MAX_MISSING_COUNT)
  834                         mt_entry->missing_count++;
  835 
  836                 /*
  837                  * When using Enc/Slot mapping, when a device is removed, it's
  838                  * mapping table information should be cleared. Otherwise, the
  839                  * target ID will be incorrect if this same device is re-added
  840                  * to a different slot.
  841                  */
  842                 if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) ==
  843                     MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) {
  844                         _mapping_clear_map_entry(mt_entry);
  845                 }
  846 
  847                 /*
  848                  * When using device mapping, update the missing count in the
  849                  * DPM entry, but only if the missing count has changed.
  850                  */
  851                 if (((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) ==
  852                     MPI2_IOCPAGE8_FLAGS_DEVICE_PERSISTENCE_MAPPING) &&
  853                     sc->is_dpm_enable &&
  854                     mt_entry->dpm_entry_num != MPS_DPM_BAD_IDX) {
  855                         dpm_entry =
  856                             (Mpi2DriverMap0Entry_t *) ((u8 *)sc->dpm_pg0 +
  857                             sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
  858                         dpm_entry += mt_entry->dpm_entry_num;
  859                         if (dpm_entry->MappingInformation !=
  860                             mt_entry->missing_count) {
  861                                 dpm_entry->MappingInformation =
  862                                     mt_entry->missing_count;
  863                                 sc->dpm_flush_entry[mt_entry->dpm_entry_num] =
  864                                     1;
  865                         }
  866                 }
  867         }
  868 }
  869 
  870 /**
  871  * _mapping_find_enc_map_space -find map table entries for enclosure
  872  * @sc: per adapter object
  873  * @et_entry: enclosure entry
  874  *
  875  * Search through the mapping table defragment it and provide contiguous
  876  * space in map table for a particular enclosure entry
  877  *
  878  * Returns start index in map table or bad index.
  879  */
  880 static u32
  881 _mapping_find_enc_map_space(struct mps_softc *sc,
  882     struct enc_mapping_table *et_entry)
  883 {
  884         u16 vol_mapping_flags;
  885         u32 skip_count, end_of_table, map_idx, enc_idx;
  886         u16 num_found;
  887         u32 start_idx = MPS_MAPTABLE_BAD_IDX;
  888         struct dev_mapping_table *mt_entry;
  889         struct enc_mapping_table *enc_entry;
  890         unsigned char done_flag = 0, found_space;
  891         u16 max_num_phy_ids = le16toh(sc->ioc_pg8.MaxNumPhysicalMappedIDs);
  892 
  893         skip_count = sc->num_rsvd_entries;
  894         num_found = 0;
  895 
  896         vol_mapping_flags = le16toh(sc->ioc_pg8.IRVolumeMappingFlags) &
  897             MPI2_IOCPAGE8_IRFLAGS_MASK_VOLUME_MAPPING_MODE;
  898 
  899         /*
  900          * The end of the mapping table depends on where volumes are kept, if
  901          * IR is enabled.
  902          */
  903         if (!sc->ir_firmware)
  904                 end_of_table = sc->max_devices;
  905         else if (vol_mapping_flags == MPI2_IOCPAGE8_IRFLAGS_LOW_VOLUME_MAPPING)
  906                 end_of_table = sc->max_devices;
  907         else
  908                 end_of_table = sc->max_devices - sc->max_volumes;
  909 
  910         /*
  911          * The skip_count is the number of entries that are reserved at the
  912          * beginning of the mapping table. But, it does not include the number
  913          * of Physical IDs that are reserved for direct attached devices. Look
  914          * through the mapping table after these reserved entries to see if 
  915          * the devices for this enclosure are already mapped. The PHY bit check
  916          * is used to make sure that at least one PHY bit is common between the
  917          * enclosure and the device that is already mapped.
  918          */
  919         mps_dprint(sc, MPS_MAPPING, "%s: Looking for space in the mapping "
  920             "table for added enclosure.\n", __func__);
  921         for (map_idx = (max_num_phy_ids + skip_count);
  922             map_idx < end_of_table; map_idx++) {
  923                 mt_entry = &sc->mapping_table[map_idx];
  924                 if ((et_entry->enclosure_id == mt_entry->physical_id) &&
  925                     (!mt_entry->phy_bits || (mt_entry->phy_bits &
  926                     et_entry->phy_bits))) {
  927                         num_found += 1;
  928                         if (num_found == et_entry->num_slots) {
  929                                 start_idx = (map_idx - num_found) + 1;
  930                                 mps_dprint(sc, MPS_MAPPING, "%s: Found space "
  931                                     "in the mapping for enclosure at map index "
  932                                     "%d.\n", __func__, start_idx);
  933                                 return start_idx;
  934                         }
  935                 } else
  936                         num_found = 0;
  937         }
  938 
  939         /*
  940          * If the enclosure's devices are not mapped already, look for
  941          * contiguous entries in the mapping table that are not reserved. If
  942          * enough entries are found, return the starting index for that space.
  943          */
  944         num_found = 0;
  945         for (map_idx = (max_num_phy_ids + skip_count);
  946             map_idx < end_of_table; map_idx++) {
  947                 mt_entry = &sc->mapping_table[map_idx];
  948                 if (!(mt_entry->device_info & MPS_DEV_RESERVED)) {
  949                         num_found += 1;
  950                         if (num_found == et_entry->num_slots) {
  951                                 start_idx = (map_idx - num_found) + 1;
  952                                 mps_dprint(sc, MPS_MAPPING, "%s: Found space "
  953                                     "in the mapping for enclosure at map index "
  954                                     "%d.\n", __func__, start_idx);
  955                                 return start_idx;
  956                         }
  957                 } else
  958                         num_found = 0;
  959         }
  960 
  961         /*
  962          * If here, it means that not enough space in the mapping table was
  963          * found to support this enclosure, so go through the enclosure table to
  964          * see if any enclosure entries have a missing count. If so, get the
  965          * enclosure with the highest missing count and check it to see if there
  966          * is enough space for the new enclosure.
  967          */
  968         while (!done_flag) {
  969                 enc_idx = _mapping_get_high_missing_et_idx(sc);
  970                 if (enc_idx == MPS_ENCTABLE_BAD_IDX) {
  971                         mps_dprint(sc, MPS_MAPPING, "%s: Not enough space was "
  972                             "found in the mapping for the added enclosure.\n",
  973                             __func__);
  974                         return MPS_MAPTABLE_BAD_IDX;
  975                 }
  976 
  977                 /*
  978                  * Found a missing enclosure. Set the skip_search flag so this
  979                  * enclosure is not checked again for a high missing count if
  980                  * the loop continues. This way, all missing enclosures can
  981                  * have their space added together to find enough space in the
  982                  * mapping table for the added enclosure. The space must be
  983                  * contiguous.
  984                  */
  985                 mps_dprint(sc, MPS_MAPPING, "%s: Space from a missing "
  986                     "enclosure was found.\n", __func__);
  987                 enc_entry = &sc->enclosure_table[enc_idx];
  988                 enc_entry->skip_search = 1;
  989 
  990                 /*
  991                  * Unmark all of the missing enclosure's device's reserved
  992                  * space. These will be remarked as reserved if this missing
  993                  * enclosure's space is not used.
  994                  */
  995                 mps_dprint(sc, MPS_MAPPING, "%s: Clear the reserved flag for "
  996                     "all of the map entries for the enclosure.\n", __func__);
  997                 mt_entry = &sc->mapping_table[enc_entry->start_index];
  998                 for (map_idx = enc_entry->start_index; map_idx <
  999                     (enc_entry->start_index + enc_entry->num_slots); map_idx++,
 1000                     mt_entry++)
 1001                         mt_entry->device_info &= ~MPS_DEV_RESERVED;
 1002 
 1003                 /*
 1004                  * Now that space has been unreserved, check again to see if
 1005                  * enough space is available for the new enclosure.
 1006                  */
 1007                 mps_dprint(sc, MPS_MAPPING, "%s: Check if new mapping space is "
 1008                     "enough for the new enclosure.\n", __func__);
 1009                 found_space = 0;
 1010                 num_found = 0;
 1011                 for (map_idx = (max_num_phy_ids + skip_count);
 1012                     map_idx < end_of_table; map_idx++) {
 1013                         mt_entry = &sc->mapping_table[map_idx];
 1014                         if (!(mt_entry->device_info & MPS_DEV_RESERVED)) {
 1015                                 num_found += 1;
 1016                                 if (num_found == et_entry->num_slots) {
 1017                                         start_idx = (map_idx - num_found) + 1;
 1018                                         found_space = 1;
 1019                                         break;
 1020                                 }
 1021                         } else
 1022                                 num_found = 0;
 1023                 }
 1024                 if (!found_space)
 1025                         continue;
 1026 
 1027                 /*
 1028                  * If enough space was found, all of the missing enclosures that
 1029                  * will be used for the new enclosure must be added to the
 1030                  * removal table. Then all mappings for the enclosure's devices
 1031                  * and for the enclosure itself need to be cleared. There may be
 1032                  * more than one enclosure to add to the removal table and
 1033                  * clear.
 1034                  */
 1035                 mps_dprint(sc, MPS_MAPPING, "%s: Found space in the mapping "
 1036                     "for enclosure at map index %d.\n", __func__, start_idx);
 1037                 for (map_idx = start_idx; map_idx < (start_idx + num_found);
 1038                     map_idx++) {
 1039                         enc_entry = sc->enclosure_table;
 1040                         for (enc_idx = 0; enc_idx < sc->num_enc_table_entries;
 1041                             enc_idx++, enc_entry++) {
 1042                                 if (map_idx < enc_entry->start_index ||
 1043                                     map_idx > (enc_entry->start_index +
 1044                                     enc_entry->num_slots))
 1045                                         continue;
 1046                                 if (!enc_entry->removal_flag) {
 1047                                         mps_dprint(sc, MPS_MAPPING, "%s: "
 1048                                             "Enclosure %d will be removed from "
 1049                                             "the mapping table.\n", __func__,
 1050                                             enc_idx);
 1051                                         enc_entry->removal_flag = 1;
 1052                                         _mapping_add_to_removal_table(sc,
 1053                                             enc_entry->dpm_entry_num);
 1054                                 }
 1055                                 mt_entry = &sc->mapping_table[map_idx];
 1056                                 _mapping_clear_map_entry(mt_entry);
 1057                                 if (map_idx == (enc_entry->start_index +
 1058                                     enc_entry->num_slots - 1))
 1059                                         _mapping_clear_enc_entry(et_entry);
 1060                         }
 1061                 }
 1062 
 1063                 /*
 1064                  * During the search for space for this enclosure, some entries
 1065                  * in the mapping table may have been unreserved. Go back and
 1066                  * change all of these to reserved again. Only the enclosures
 1067                  * with the removal_flag set should be left as unreserved. The
 1068                  * skip_search flag needs to be cleared as well so that the
 1069                  * enclosure's space will be looked at the next time space is
 1070                  * needed.
 1071                  */ 
 1072                 enc_entry = sc->enclosure_table;
 1073                 for (enc_idx = 0; enc_idx < sc->num_enc_table_entries;
 1074                     enc_idx++, enc_entry++) {
 1075                         if (!enc_entry->removal_flag) {
 1076                                 mps_dprint(sc, MPS_MAPPING, "%s: Reset the "
 1077                                     "reserved flag for all of the map entries "
 1078                                     "for enclosure %d.\n", __func__, enc_idx);
 1079                                 mt_entry = &sc->mapping_table[enc_entry->
 1080                                     start_index];
 1081                                 for (map_idx = enc_entry->start_index; map_idx <
 1082                                     (enc_entry->start_index +
 1083                                     enc_entry->num_slots); map_idx++,
 1084                                     mt_entry++)
 1085                                         mt_entry->device_info |=
 1086                                             MPS_DEV_RESERVED;
 1087                                 et_entry->skip_search = 0;
 1088                         }
 1089                 }
 1090                 done_flag = 1;
 1091         }
 1092         return start_idx;
 1093 }
 1094 
 1095 /**
 1096  * _mapping_get_dev_info -get information about newly added devices
 1097  * @sc: per adapter object
 1098  * @topo_change: Topology change event entry
 1099  *
 1100  * Search through the topology change event list and issues sas device pg0
 1101  * requests for the newly added device and reserved entries in tables
 1102  *
 1103  * Returns nothing
 1104  */
 1105 static void
 1106 _mapping_get_dev_info(struct mps_softc *sc,
 1107     struct _map_topology_change *topo_change)
 1108 {
 1109         u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags);
 1110         Mpi2ConfigReply_t mpi_reply;
 1111         Mpi2SasDevicePage0_t sas_device_pg0;
 1112         u8 entry, enc_idx, phy_idx;
 1113         u32 map_idx, index, device_info;
 1114         struct _map_phy_change *phy_change, *tmp_phy_change;
 1115         uint64_t sas_address;
 1116         struct enc_mapping_table *et_entry;
 1117         struct dev_mapping_table *mt_entry;
 1118         u8 add_code = MPI2_EVENT_SAS_TOPO_RC_TARG_ADDED;
 1119         int rc = 1;
 1120 
 1121         for (entry = 0; entry < topo_change->num_entries; entry++) {
 1122                 phy_change = &topo_change->phy_details[entry];
 1123                 if (phy_change->is_processed || !phy_change->dev_handle ||
 1124                     phy_change->reason != MPI2_EVENT_SAS_TOPO_RC_TARG_ADDED)
 1125                         continue;
 1126 
 1127                 if (mps_config_get_sas_device_pg0(sc, &mpi_reply,
 1128                     &sas_device_pg0, MPI2_SAS_DEVICE_PGAD_FORM_HANDLE,
 1129                     phy_change->dev_handle)) {
 1130                         phy_change->is_processed = 1;
 1131                         continue;
 1132                 }
 1133 
 1134                 /*
 1135                  * Always get SATA Identify information because this is used
 1136                  * to determine if Start/Stop Unit should be sent to the drive
 1137                  * when the system is shutdown.
 1138                  */
 1139                 device_info = le32toh(sas_device_pg0.DeviceInfo);
 1140                 sas_address = le32toh(sas_device_pg0.SASAddress.High);
 1141                 sas_address = (sas_address << 32) |
 1142                     le32toh(sas_device_pg0.SASAddress.Low);
 1143                 if ((device_info & MPI2_SAS_DEVICE_INFO_END_DEVICE) &&
 1144                     (device_info & MPI2_SAS_DEVICE_INFO_SATA_DEVICE)) {
 1145                         rc = mpssas_get_sas_address_for_sata_disk(sc,
 1146                             &sas_address, phy_change->dev_handle, device_info,
 1147                             &phy_change->is_SATA_SSD);
 1148                         if (rc) {
 1149                                 mps_dprint(sc, MPS_ERROR, "%s: failed to get "
 1150                                     "disk type (SSD or HDD) and SAS Address "
 1151                                     "for SATA device with handle 0x%04x\n",
 1152                                     __func__, phy_change->dev_handle);
 1153                         }
 1154                 }
 1155 
 1156                 phy_change->physical_id = sas_address;
 1157                 phy_change->slot = le16toh(sas_device_pg0.Slot);
 1158                 phy_change->device_info = device_info;
 1159 
 1160                 /*
 1161                  * When using Enc/Slot mapping, if this device is an enclosure
 1162                  * make sure that all of its slots can fit into the mapping
 1163                  * table.
 1164                  */
 1165                 if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) ==
 1166                     MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) {
 1167                         /*
 1168                          * The enclosure should already be in the enclosure
 1169                          * table due to the Enclosure Add event. If not, just
 1170                          * continue, nothing can be done.
 1171                          */
 1172                         enc_idx = _mapping_get_enc_idx_from_handle(sc,
 1173                             topo_change->enc_handle);
 1174                         if (enc_idx == MPS_ENCTABLE_BAD_IDX) {
 1175                                 phy_change->is_processed = 1;
 1176                                 mps_dprint(sc, MPS_ERROR | MPS_MAPPING, "%s: "
 1177                                     "failed to add the device with handle "
 1178                                     "0x%04x because enclosure handle 0x%04x "
 1179                                     "is not in the mapping table\n", __func__,
 1180                                     phy_change->dev_handle,
 1181                                     topo_change->enc_handle);
 1182                                 continue;
 1183                         }
 1184                         if (!((phy_change->device_info &
 1185                             MPI2_SAS_DEVICE_INFO_END_DEVICE) &&
 1186                             (phy_change->device_info &
 1187                             (MPI2_SAS_DEVICE_INFO_SSP_TARGET |
 1188                             MPI2_SAS_DEVICE_INFO_STP_TARGET |
 1189                             MPI2_SAS_DEVICE_INFO_SATA_DEVICE)))) {
 1190                                 phy_change->is_processed = 1;
 1191                                 continue;
 1192                         }
 1193                         et_entry = &sc->enclosure_table[enc_idx];
 1194 
 1195                         /*
 1196                          * If the enclosure already has a start_index, it's been
 1197                          * mapped, so go to the next Topo change.
 1198                          */
 1199                         if (et_entry->start_index != MPS_MAPTABLE_BAD_IDX)
 1200                                 continue;
 1201 
 1202                         /*
 1203                          * If the Expander Handle is 0, the devices are direct
 1204                          * attached. In that case, the start_index must be just 
 1205                          * after the reserved entries. Otherwise, find space in
 1206                          * the mapping table for the enclosure's devices.
 1207                          */ 
 1208                         if (!topo_change->exp_handle) {
 1209                                 map_idx = sc->num_rsvd_entries;
 1210                                 et_entry->start_index = map_idx;
 1211                         } else {
 1212                                 map_idx = _mapping_find_enc_map_space(sc,
 1213                                     et_entry);
 1214                                 et_entry->start_index = map_idx;
 1215 
 1216                                 /*
 1217                                  * If space cannot be found to hold all of the
 1218                                  * enclosure's devices in the mapping table,
 1219                                  * there's no need to continue checking the
 1220                                  * other devices in this event. Set all of the
 1221                                  * phy_details for this event (if the change is
 1222                                  * for an add) as already processed because none
 1223                                  * of these devices can be added to the mapping
 1224                                  * table.
 1225                                  */
 1226                                 if (et_entry->start_index ==
 1227                                     MPS_MAPTABLE_BAD_IDX) {
 1228                                         mps_dprint(sc, MPS_ERROR | MPS_MAPPING,
 1229                                             "%s: failed to add the enclosure "
 1230                                             "with ID 0x%016jx because there is "
 1231                                             "no free space available in the "
 1232                                             "mapping table for all of the "
 1233                                             "enclosure's devices.\n", __func__,
 1234                                             (uintmax_t)et_entry->enclosure_id);
 1235                                         phy_change->is_processed = 1;
 1236                                         for (phy_idx = 0; phy_idx <
 1237                                             topo_change->num_entries;
 1238                                             phy_idx++) {
 1239                                                 tmp_phy_change =
 1240                                                     &topo_change->phy_details
 1241                                                     [phy_idx];
 1242                                                 if (tmp_phy_change->reason ==
 1243                                                     add_code)
 1244                                                         tmp_phy_change->
 1245                                                             is_processed = 1;
 1246                                         }
 1247                                         break;
 1248                                 }
 1249                         }
 1250 
 1251                         /*
 1252                          * Found space in the mapping table for this enclosure.
 1253                          * Initialize each mapping table entry for the
 1254                          * enclosure.
 1255                          */
 1256                         mps_dprint(sc, MPS_MAPPING, "%s: Initialize %d map "
 1257                             "entries for the enclosure, starting at map index "
 1258                             " %d.\n", __func__, et_entry->num_slots, map_idx);
 1259                         mt_entry = &sc->mapping_table[map_idx];
 1260                         for (index = map_idx; index < (et_entry->num_slots
 1261                             + map_idx); index++, mt_entry++) {
 1262                                 mt_entry->device_info = MPS_DEV_RESERVED;
 1263                                 mt_entry->physical_id = et_entry->enclosure_id;
 1264                                 mt_entry->phy_bits = et_entry->phy_bits;
 1265                                 mt_entry->missing_count = 0;
 1266                         }
 1267                 }
 1268         }
 1269 }
 1270 
 1271 /**
 1272  * _mapping_set_mid_to_eid -set map table data from enclosure table
 1273  * @sc: per adapter object
 1274  * @et_entry: enclosure entry
 1275  *
 1276  * Returns nothing
 1277  */
 1278 static inline void
 1279 _mapping_set_mid_to_eid(struct mps_softc *sc,
 1280     struct enc_mapping_table *et_entry)
 1281 {
 1282         struct dev_mapping_table *mt_entry;
 1283         u16 slots = et_entry->num_slots, map_idx;
 1284         u32 start_idx = et_entry->start_index;
 1285 
 1286         if (start_idx != MPS_MAPTABLE_BAD_IDX) {
 1287                 mt_entry = &sc->mapping_table[start_idx];
 1288                 for (map_idx = 0; map_idx < slots; map_idx++, mt_entry++)
 1289                         mt_entry->physical_id = et_entry->enclosure_id;
 1290         }
 1291 }
 1292 
 1293 /**
 1294  * _mapping_clear_removed_entries - mark the entries to be cleared
 1295  * @sc: per adapter object
 1296  *
 1297  * Search through the removal table and mark the entries which needs to be
 1298  * flushed to DPM and also updates the map table and enclosure table by
 1299  * clearing the corresponding entries.
 1300  *
 1301  * Returns nothing
 1302  */
 1303 static void
 1304 _mapping_clear_removed_entries(struct mps_softc *sc)
 1305 {
 1306         u32 remove_idx;
 1307         struct map_removal_table *remove_entry;
 1308         Mpi2DriverMap0Entry_t *dpm_entry;
 1309         u8 done_flag = 0, num_entries, m, i;
 1310         struct enc_mapping_table *et_entry, *from, *to;
 1311         u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags);
 1312 
 1313         if (sc->is_dpm_enable) {
 1314                 remove_entry = sc->removal_table;
 1315                 for (remove_idx = 0; remove_idx < sc->max_devices;
 1316                     remove_idx++, remove_entry++) {
 1317                         if (remove_entry->dpm_entry_num != MPS_DPM_BAD_IDX) {
 1318                                 dpm_entry = (Mpi2DriverMap0Entry_t *)
 1319                                     ((u8 *) sc->dpm_pg0 +
 1320                                     sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
 1321                                 dpm_entry += remove_entry->dpm_entry_num;
 1322                                 dpm_entry->PhysicalIdentifier.Low = 0;
 1323                                 dpm_entry->PhysicalIdentifier.High = 0;
 1324                                 dpm_entry->DeviceIndex = 0;
 1325                                 dpm_entry->MappingInformation = 0;
 1326                                 dpm_entry->PhysicalBitsMapping = 0;
 1327                                 sc->dpm_flush_entry[remove_entry->
 1328                                     dpm_entry_num] = 1;
 1329                                 sc->dpm_entry_used[remove_entry->dpm_entry_num]
 1330                                     = 0;
 1331                                 remove_entry->dpm_entry_num = MPS_DPM_BAD_IDX;
 1332                         }
 1333                 }
 1334         }
 1335 
 1336         /*
 1337          * When using Enc/Slot mapping, if a new enclosure was added and old
 1338          * enclosure space was needed, the enclosure table may now have gaps
 1339          * that need to be closed. All enclosure mappings need to be contiguous
 1340          * so that space can be reused correctly if available.
 1341          */
 1342         if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) ==
 1343             MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) {
 1344                 num_entries = sc->num_enc_table_entries;
 1345                 while (!done_flag) {
 1346                         done_flag = 1;
 1347                         et_entry = sc->enclosure_table;
 1348                         for (i = 0; i < num_entries; i++, et_entry++) {
 1349                                 if (!et_entry->enc_handle && et_entry->
 1350                                     init_complete) {
 1351                                         done_flag = 0;
 1352                                         if (i != (num_entries - 1)) {
 1353                                                 from = &sc->enclosure_table
 1354                                                     [i+1];
 1355                                                 to = &sc->enclosure_table[i];
 1356                                                 for (m = i; m < (num_entries -
 1357                                                     1); m++, from++, to++) {
 1358                                                         _mapping_set_mid_to_eid
 1359                                                             (sc, to);
 1360                                                         *to = *from;
 1361                                                 }
 1362                                                 _mapping_clear_enc_entry(to);
 1363                                                 sc->num_enc_table_entries--;
 1364                                                 num_entries =
 1365                                                     sc->num_enc_table_entries;
 1366                                         } else {
 1367                                                 _mapping_clear_enc_entry
 1368                                                     (et_entry);
 1369                                                 sc->num_enc_table_entries--;
 1370                                                 num_entries =
 1371                                                     sc->num_enc_table_entries;
 1372                                         }
 1373                                 }
 1374                         }
 1375                 }
 1376         }
 1377 }
 1378 
 1379 /**
 1380  * _mapping_add_new_device -Add the new device into mapping table
 1381  * @sc: per adapter object
 1382  * @topo_change: Topology change event entry
 1383  *
 1384  * Search through the topology change event list and update map table,
 1385  * enclosure table and DPM pages for the newly added devices.
 1386  *
 1387  * Returns nothing
 1388  */
 1389 static void
 1390 _mapping_add_new_device(struct mps_softc *sc,
 1391     struct _map_topology_change *topo_change)
 1392 {
 1393         u8 enc_idx, missing_cnt, is_removed = 0;
 1394         u16 dpm_idx;
 1395         u32 search_idx, map_idx;
 1396         u32 entry;
 1397         struct dev_mapping_table *mt_entry;
 1398         struct enc_mapping_table *et_entry;
 1399         struct _map_phy_change *phy_change;
 1400         u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags);
 1401         Mpi2DriverMap0Entry_t *dpm_entry;
 1402         uint64_t temp64_var;
 1403         u8 map_shift = MPI2_DRVMAP0_MAPINFO_SLOT_SHIFT;
 1404         u8 hdr_sz = sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER);
 1405         u16 max_num_phy_ids = le16toh(sc->ioc_pg8.MaxNumPhysicalMappedIDs);
 1406 
 1407         for (entry = 0; entry < topo_change->num_entries; entry++) {
 1408                 phy_change = &topo_change->phy_details[entry];
 1409                 if (phy_change->is_processed)
 1410                         continue;
 1411                 if (phy_change->reason != MPI2_EVENT_SAS_TOPO_RC_TARG_ADDED ||
 1412                     !phy_change->dev_handle) {
 1413                         phy_change->is_processed = 1;
 1414                         continue;
 1415                 }
 1416                 if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) ==
 1417                     MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) {
 1418                         enc_idx = _mapping_get_enc_idx_from_handle
 1419                             (sc, topo_change->enc_handle);
 1420                         if (enc_idx == MPS_ENCTABLE_BAD_IDX) {
 1421                                 phy_change->is_processed = 1;
 1422                                 mps_dprint(sc, MPS_ERROR | MPS_MAPPING, "%s: "
 1423                                     "failed to add the device with handle "
 1424                                     "0x%04x because enclosure handle 0x%04x "
 1425                                     "is not in the mapping table\n", __func__,
 1426                                     phy_change->dev_handle,
 1427                                     topo_change->enc_handle);
 1428                                 continue;
 1429                         }
 1430 
 1431                         /*
 1432                          * If the enclosure's start_index is BAD here, it means
 1433                          * that there is no room in the mapping table to cover
 1434                          * all of the devices that could be in the enclosure.
 1435                          * There's no reason to process any of the devices for
 1436                          * this enclosure since they can't be mapped.
 1437                          */
 1438                         et_entry = &sc->enclosure_table[enc_idx];
 1439                         if (et_entry->start_index == MPS_MAPTABLE_BAD_IDX) {
 1440                                 phy_change->is_processed = 1;
 1441                                 mps_dprint(sc, MPS_ERROR | MPS_MAPPING, "%s: "
 1442                                     "failed to add the device with handle "
 1443                                     "0x%04x because there is no free space "
 1444                                     "available in the mapping table\n",
 1445                                     __func__, phy_change->dev_handle);
 1446                                 continue;
 1447                         }
 1448 
 1449                         /*
 1450                          * Add this device to the mapping table at the correct
 1451                          * offset where space was found to map the enclosure.
 1452                          * Then setup the DPM entry information if being used.
 1453                          */
 1454                         map_idx = et_entry->start_index + phy_change->slot -
 1455                             et_entry->start_slot;
 1456                         mt_entry = &sc->mapping_table[map_idx];
 1457                         mt_entry->physical_id = phy_change->physical_id;
 1458                         mt_entry->id = map_idx;
 1459                         mt_entry->dev_handle = phy_change->dev_handle;
 1460                         mt_entry->missing_count = 0;
 1461                         mt_entry->dpm_entry_num = et_entry->dpm_entry_num;
 1462                         mt_entry->device_info = phy_change->device_info |
 1463                             (MPS_DEV_RESERVED | MPS_MAP_IN_USE);
 1464                         if (sc->is_dpm_enable) {
 1465                                 dpm_idx = et_entry->dpm_entry_num;
 1466                                 if (dpm_idx == MPS_DPM_BAD_IDX)
 1467                                         dpm_idx = _mapping_get_dpm_idx_from_id
 1468                                             (sc, et_entry->enclosure_id,
 1469                                              et_entry->phy_bits);
 1470                                 if (dpm_idx == MPS_DPM_BAD_IDX) {
 1471                                         dpm_idx = _mapping_get_free_dpm_idx(sc);
 1472                                         if (dpm_idx != MPS_DPM_BAD_IDX) {
 1473                                                 dpm_entry =
 1474                                                     (Mpi2DriverMap0Entry_t *)
 1475                                                     ((u8 *) sc->dpm_pg0 +
 1476                                                      hdr_sz);
 1477                                                 dpm_entry += dpm_idx;
 1478                                                 dpm_entry->
 1479                                                     PhysicalIdentifier.Low =
 1480                                                     (0xFFFFFFFF &
 1481                                                     et_entry->enclosure_id);
 1482                                                 dpm_entry->
 1483                                                     PhysicalIdentifier.High =
 1484                                                     (et_entry->enclosure_id
 1485                                                      >> 32);
 1486                                                 dpm_entry->DeviceIndex =
 1487                                                     (U16)et_entry->start_index;
 1488                                                 dpm_entry->MappingInformation =
 1489                                                     et_entry->num_slots;
 1490                                                 dpm_entry->MappingInformation
 1491                                                     <<= map_shift;
 1492                                                 dpm_entry->PhysicalBitsMapping
 1493                                                     = et_entry->phy_bits;
 1494                                                 et_entry->dpm_entry_num =
 1495                                                     dpm_idx;
 1496                                                 sc->dpm_entry_used[dpm_idx] = 1;
 1497                                                 sc->dpm_flush_entry[dpm_idx] =
 1498                                                     1;
 1499                                                 phy_change->is_processed = 1;
 1500                                         } else {
 1501                                                 phy_change->is_processed = 1;
 1502                                                 mps_dprint(sc, MPS_ERROR |
 1503                                                     MPS_MAPPING, "%s: failed "
 1504                                                     "to add the device with "
 1505                                                     "handle 0x%04x to "
 1506                                                     "persistent table because "
 1507                                                     "there is no free space "
 1508                                                     "available\n", __func__,
 1509                                                     phy_change->dev_handle);
 1510                                         }
 1511                                 } else {
 1512                                         et_entry->dpm_entry_num = dpm_idx;
 1513                                         mt_entry->dpm_entry_num = dpm_idx;
 1514                                 }
 1515                         }
 1516                         et_entry->init_complete = 1;
 1517                 } else if ((ioc_pg8_flags &
 1518                     MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) ==
 1519                     MPI2_IOCPAGE8_FLAGS_DEVICE_PERSISTENCE_MAPPING) {
 1520                         /*
 1521                          * Get the mapping table index for this device. If it's
 1522                          * not in the mapping table yet, find a free entry if
 1523                          * one is available. If there are no free entries, look
 1524                          * for the entry that has the highest missing count. If
 1525                          * none of that works to find an entry in the mapping
 1526                          * table, there is a problem. Log a message and just
 1527                          * continue on.
 1528                          */
 1529                         map_idx = _mapping_get_mt_idx_from_id
 1530                             (sc, phy_change->physical_id);
 1531                         if (map_idx == MPS_MAPTABLE_BAD_IDX) {
 1532                                 search_idx = sc->num_rsvd_entries;
 1533                                 if (topo_change->exp_handle)
 1534                                         search_idx += max_num_phy_ids;
 1535                                 map_idx = _mapping_get_free_mt_idx(sc,
 1536                                     search_idx);
 1537                         }
 1538 
 1539                         /*
 1540                          * If an entry will be used that has a missing device,
 1541                          * clear its entry from  the DPM in the controller.
 1542                          */
 1543                         if (map_idx == MPS_MAPTABLE_BAD_IDX) {
 1544                                 map_idx = _mapping_get_high_missing_mt_idx(sc);
 1545                                 if (map_idx != MPS_MAPTABLE_BAD_IDX) {
 1546                                         mt_entry = &sc->mapping_table[map_idx];
 1547                                         _mapping_add_to_removal_table(sc,
 1548                                             mt_entry->dpm_entry_num);
 1549                                         is_removed = 1;
 1550                                         mt_entry->init_complete = 0;
 1551                                 }
 1552                         }
 1553                         if (map_idx != MPS_MAPTABLE_BAD_IDX) {
 1554                                 mt_entry = &sc->mapping_table[map_idx];
 1555                                 mt_entry->physical_id = phy_change->physical_id;
 1556                                 mt_entry->id = map_idx;
 1557                                 mt_entry->dev_handle = phy_change->dev_handle;
 1558                                 mt_entry->missing_count = 0;
 1559                                 mt_entry->device_info = phy_change->device_info
 1560                                     | (MPS_DEV_RESERVED | MPS_MAP_IN_USE);
 1561                         } else {
 1562                                 phy_change->is_processed = 1;
 1563                                 mps_dprint(sc, MPS_ERROR | MPS_MAPPING, "%s: "
 1564                                     "failed to add the device with handle "
 1565                                     "0x%04x because there is no free space "
 1566                                     "available in the mapping table\n",
 1567                                     __func__, phy_change->dev_handle);
 1568                                 continue;
 1569                         }
 1570                         if (sc->is_dpm_enable) {
 1571                                 if (mt_entry->dpm_entry_num !=
 1572                                     MPS_DPM_BAD_IDX) {
 1573                                         dpm_idx = mt_entry->dpm_entry_num;
 1574                                         dpm_entry = (Mpi2DriverMap0Entry_t *)
 1575                                             ((u8 *)sc->dpm_pg0 + hdr_sz);
 1576                                         dpm_entry += dpm_idx;
 1577                                         missing_cnt = dpm_entry->
 1578                                             MappingInformation &
 1579                                             MPI2_DRVMAP0_MAPINFO_MISSING_MASK;
 1580                                         temp64_var = dpm_entry->
 1581                                             PhysicalIdentifier.High;
 1582                                         temp64_var = (temp64_var << 32) |
 1583                                            dpm_entry->PhysicalIdentifier.Low;
 1584 
 1585                                         /*
 1586                                          * If the Mapping Table's info is not
 1587                                          * the same as the DPM entry, clear the
 1588                                          * init_complete flag so that it's
 1589                                          * updated.
 1590                                          */
 1591                                         if ((mt_entry->physical_id ==
 1592                                             temp64_var) && !missing_cnt)
 1593                                                 mt_entry->init_complete = 1;
 1594                                         else
 1595                                                 mt_entry->init_complete = 0;
 1596                                 } else {
 1597                                         dpm_idx = _mapping_get_free_dpm_idx(sc);
 1598                                         mt_entry->init_complete = 0;
 1599                                 }
 1600                                 if (dpm_idx != MPS_DPM_BAD_IDX &&
 1601                                     !mt_entry->init_complete) {
 1602                                         mt_entry->dpm_entry_num = dpm_idx;
 1603                                         dpm_entry = (Mpi2DriverMap0Entry_t *)
 1604                                             ((u8 *)sc->dpm_pg0 + hdr_sz);
 1605                                         dpm_entry += dpm_idx;
 1606                                         dpm_entry->PhysicalIdentifier.Low =
 1607                                             (0xFFFFFFFF &
 1608                                             mt_entry->physical_id);
 1609                                         dpm_entry->PhysicalIdentifier.High =
 1610                                             (mt_entry->physical_id >> 32);
 1611                                         dpm_entry->DeviceIndex = (U16) map_idx;
 1612                                         dpm_entry->MappingInformation = 0;
 1613                                         dpm_entry->PhysicalBitsMapping = 0;
 1614                                         sc->dpm_entry_used[dpm_idx] = 1;
 1615                                         sc->dpm_flush_entry[dpm_idx] = 1;
 1616                                         phy_change->is_processed = 1;
 1617                                 } else if (dpm_idx == MPS_DPM_BAD_IDX) {
 1618                                         phy_change->is_processed = 1;
 1619                                         mps_dprint(sc, MPS_ERROR | MPS_MAPPING,
 1620                                             "%s: failed to add the device with "
 1621                                             "handle 0x%04x to persistent table "
 1622                                             "because there is no free space "
 1623                                             "available\n", __func__,
 1624                                             phy_change->dev_handle);
 1625                                 }
 1626                         }
 1627                         mt_entry->init_complete = 1;
 1628                 }
 1629 
 1630                 phy_change->is_processed = 1;
 1631         }
 1632         if (is_removed)
 1633                 _mapping_clear_removed_entries(sc);
 1634 }
 1635 
 1636 /**
 1637  * _mapping_flush_dpm_pages -Flush the DPM pages to NVRAM
 1638  * @sc: per adapter object
 1639  *
 1640  * Returns nothing
 1641  */
 1642 static void
 1643 _mapping_flush_dpm_pages(struct mps_softc *sc)
 1644 {
 1645         Mpi2DriverMap0Entry_t *dpm_entry;
 1646         Mpi2ConfigReply_t mpi_reply;
 1647         Mpi2DriverMappingPage0_t config_page;
 1648         u16 entry_num;
 1649 
 1650         for (entry_num = 0; entry_num < sc->max_dpm_entries; entry_num++) {
 1651                 if (!sc->dpm_flush_entry[entry_num])
 1652                         continue;
 1653                 memset(&config_page, 0, sizeof(Mpi2DriverMappingPage0_t));
 1654                 memcpy(&config_page.Header, (u8 *)sc->dpm_pg0,
 1655                     sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
 1656                 dpm_entry = (Mpi2DriverMap0Entry_t *) ((u8 *)sc->dpm_pg0 +
 1657                     sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
 1658                 dpm_entry += entry_num;
 1659                 dpm_entry->MappingInformation = htole16(dpm_entry->
 1660                     MappingInformation);
 1661                 dpm_entry->DeviceIndex = htole16(dpm_entry->DeviceIndex);
 1662                 dpm_entry->PhysicalBitsMapping = htole32(dpm_entry->
 1663                     PhysicalBitsMapping);
 1664                 memcpy(&config_page.Entry, (u8 *)dpm_entry,
 1665                     sizeof(Mpi2DriverMap0Entry_t));
 1666                 /* TODO-How to handle failed writes? */
 1667                 mps_dprint(sc, MPS_MAPPING, "%s: Flushing DPM entry %d.\n",
 1668                     __func__, entry_num);
 1669                 if (mps_config_set_dpm_pg0(sc, &mpi_reply, &config_page,
 1670                     entry_num)) {
 1671                         mps_dprint(sc, MPS_ERROR | MPS_MAPPING, "%s: Flush of "
 1672                             "DPM entry %d for device failed\n", __func__,
 1673                             entry_num);
 1674                 } else
 1675                         sc->dpm_flush_entry[entry_num] = 0;
 1676                 dpm_entry->MappingInformation = le16toh(dpm_entry->
 1677                     MappingInformation);
 1678                 dpm_entry->DeviceIndex = le16toh(dpm_entry->DeviceIndex);
 1679                 dpm_entry->PhysicalBitsMapping = le32toh(dpm_entry->
 1680                     PhysicalBitsMapping);
 1681         }
 1682 }
 1683 
 1684 /**
 1685  * _mapping_allocate_memory- allocates the memory required for mapping tables
 1686  * @sc: per adapter object
 1687  *
 1688  * Allocates the memory for all the tables required for host mapping
 1689  *
 1690  * Return 0 on success or non-zero on failure.
 1691  */
 1692 int
 1693 mps_mapping_allocate_memory(struct mps_softc *sc)
 1694 {
 1695         uint32_t dpm_pg0_sz;
 1696 
 1697         sc->mapping_table = malloc((sizeof(struct dev_mapping_table) *
 1698             sc->max_devices), M_MPT2, M_ZERO|M_NOWAIT);
 1699         if (!sc->mapping_table)
 1700                 goto free_resources;
 1701 
 1702         sc->removal_table = malloc((sizeof(struct map_removal_table) *
 1703             sc->max_devices), M_MPT2, M_ZERO|M_NOWAIT);
 1704         if (!sc->removal_table)
 1705                 goto free_resources;
 1706 
 1707         sc->enclosure_table = malloc((sizeof(struct enc_mapping_table) *
 1708             sc->max_enclosures), M_MPT2, M_ZERO|M_NOWAIT);
 1709         if (!sc->enclosure_table)
 1710                 goto free_resources;
 1711 
 1712         sc->dpm_entry_used = malloc((sizeof(u8) * sc->max_dpm_entries),
 1713             M_MPT2, M_ZERO|M_NOWAIT);
 1714         if (!sc->dpm_entry_used)
 1715                 goto free_resources;
 1716 
 1717         sc->dpm_flush_entry = malloc((sizeof(u8) * sc->max_dpm_entries),
 1718             M_MPT2, M_ZERO|M_NOWAIT);
 1719         if (!sc->dpm_flush_entry)
 1720                 goto free_resources;
 1721 
 1722         dpm_pg0_sz = sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER) +
 1723             (sc->max_dpm_entries * sizeof(MPI2_CONFIG_PAGE_DRIVER_MAP0_ENTRY));
 1724 
 1725         sc->dpm_pg0 = malloc(dpm_pg0_sz, M_MPT2, M_ZERO|M_NOWAIT);
 1726         if (!sc->dpm_pg0) {
 1727                 printf("%s: memory alloc failed for dpm page; disabling dpm\n",
 1728                     __func__);
 1729                 sc->is_dpm_enable = 0;
 1730         }
 1731 
 1732         return 0;
 1733 
 1734 free_resources:
 1735         free(sc->mapping_table, M_MPT2);
 1736         free(sc->removal_table, M_MPT2);
 1737         free(sc->enclosure_table, M_MPT2);
 1738         free(sc->dpm_entry_used, M_MPT2);
 1739         free(sc->dpm_flush_entry, M_MPT2);
 1740         free(sc->dpm_pg0, M_MPT2);
 1741         printf("%s: device initialization failed due to failure in mapping "
 1742             "table memory allocation\n", __func__);
 1743         return -1;
 1744 }
 1745 
 1746 /**
 1747  * mps_mapping_free_memory- frees the memory allocated for mapping tables
 1748  * @sc: per adapter object
 1749  *
 1750  * Returns nothing.
 1751  */
 1752 void
 1753 mps_mapping_free_memory(struct mps_softc *sc)
 1754 {
 1755         free(sc->mapping_table, M_MPT2);
 1756         free(sc->removal_table, M_MPT2);
 1757         free(sc->enclosure_table, M_MPT2);
 1758         free(sc->dpm_entry_used, M_MPT2);
 1759         free(sc->dpm_flush_entry, M_MPT2);
 1760         free(sc->dpm_pg0, M_MPT2);
 1761 }
 1762 
 1763 static void
 1764 _mapping_process_dpm_pg0(struct mps_softc *sc)
 1765 {
 1766         u8 missing_cnt, enc_idx;
 1767         u16 slot_id, entry_num, num_slots;
 1768         u32 map_idx, dev_idx, start_idx, end_idx;
 1769         struct dev_mapping_table *mt_entry;
 1770         Mpi2DriverMap0Entry_t *dpm_entry;
 1771         u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags);
 1772         u16 max_num_phy_ids = le16toh(sc->ioc_pg8.MaxNumPhysicalMappedIDs);
 1773         struct enc_mapping_table *et_entry;
 1774         u64 physical_id;
 1775         u32 phy_bits = 0;
 1776 
 1777         /*
 1778          * start_idx and end_idx are only used for IR.
 1779          */
 1780         if (sc->ir_firmware)
 1781                 _mapping_get_ir_maprange(sc, &start_idx, &end_idx);
 1782 
 1783         /*
 1784          * Look through all of the DPM entries that were read from the
 1785          * controller and copy them over to the driver's internal table if they
 1786          * have a non-zero ID. At this point, any ID with a value of 0 would be
 1787          * invalid, so don't copy it.
 1788          */
 1789         mps_dprint(sc, MPS_MAPPING, "%s: Start copy of %d DPM entries into the "
 1790             "mapping table.\n", __func__, sc->max_dpm_entries);
 1791         dpm_entry = (Mpi2DriverMap0Entry_t *) ((uint8_t *) sc->dpm_pg0 +
 1792             sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
 1793         for (entry_num = 0; entry_num < sc->max_dpm_entries; entry_num++, 
 1794             dpm_entry++) {
 1795                 physical_id = dpm_entry->PhysicalIdentifier.High;
 1796                 physical_id = (physical_id << 32) | 
 1797                     dpm_entry->PhysicalIdentifier.Low;
 1798                 if (!physical_id) {
 1799                         sc->dpm_entry_used[entry_num] = 0;
 1800                         continue;
 1801                 }
 1802                 sc->dpm_entry_used[entry_num] = 1;
 1803                 dpm_entry->MappingInformation = le16toh(dpm_entry->
 1804                     MappingInformation);
 1805                 missing_cnt = dpm_entry->MappingInformation &
 1806                     MPI2_DRVMAP0_MAPINFO_MISSING_MASK;
 1807                 dev_idx = le16toh(dpm_entry->DeviceIndex);
 1808                 phy_bits = le32toh(dpm_entry->PhysicalBitsMapping);
 1809 
 1810                 /*
 1811                  * Volumes are at special locations in the mapping table so
 1812                  * account for that. Volume mapping table entries do not depend
 1813                  * on the type of mapping, so continue the loop after adding
 1814                  * volumes to the mapping table.
 1815                  */
 1816                 if (sc->ir_firmware && (dev_idx >= start_idx) &&
 1817                     (dev_idx <= end_idx)) {
 1818                         mt_entry = &sc->mapping_table[dev_idx];
 1819                         mt_entry->physical_id =
 1820                             dpm_entry->PhysicalIdentifier.High;
 1821                         mt_entry->physical_id = (mt_entry->physical_id << 32) |
 1822                             dpm_entry->PhysicalIdentifier.Low;
 1823                         mt_entry->id = dev_idx;
 1824                         mt_entry->missing_count = missing_cnt;
 1825                         mt_entry->dpm_entry_num = entry_num;
 1826                         mt_entry->device_info = MPS_DEV_RESERVED;
 1827                         continue;
 1828                 }
 1829                 if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) ==
 1830                     MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) {
 1831                         /*
 1832                          * The dev_idx for an enclosure is the start index. If
 1833                          * the start index is within the controller's default
 1834                          * enclosure area, set the number of slots for this
 1835                          * enclosure to the max allowed. Otherwise, it should be
 1836                          * a normal enclosure and the number of slots is in the
 1837                          * DPM entry's Mapping Information.
 1838                          */
 1839                         if (dev_idx < (sc->num_rsvd_entries +
 1840                             max_num_phy_ids)) {
 1841                                 slot_id = 0;
 1842                                 if (ioc_pg8_flags &
 1843                                     MPI2_IOCPAGE8_FLAGS_DA_START_SLOT_1)
 1844                                         slot_id = 1;
 1845                                 num_slots = max_num_phy_ids;
 1846                         } else {
 1847                                 slot_id = 0;
 1848                                 num_slots = dpm_entry->MappingInformation &
 1849                                     MPI2_DRVMAP0_MAPINFO_SLOT_MASK;
 1850                                 num_slots >>= MPI2_DRVMAP0_MAPINFO_SLOT_SHIFT;
 1851                         }
 1852                         enc_idx = sc->num_enc_table_entries;
 1853                         if (enc_idx >= sc->max_enclosures) {
 1854                                 mps_dprint(sc, MPS_ERROR | MPS_MAPPING, "%s: "
 1855                                     "Number of enclosure entries in DPM exceed "
 1856                                     "the max allowed of %d.\n", __func__,
 1857                                     sc->max_enclosures);
 1858                                 break;
 1859                         }
 1860                         sc->num_enc_table_entries++;
 1861                         et_entry = &sc->enclosure_table[enc_idx];
 1862                         physical_id = dpm_entry->PhysicalIdentifier.High;
 1863                         et_entry->enclosure_id = (physical_id << 32) |
 1864                             dpm_entry->PhysicalIdentifier.Low;
 1865                         et_entry->start_index = dev_idx;
 1866                         et_entry->dpm_entry_num = entry_num;
 1867                         et_entry->num_slots = num_slots;
 1868                         et_entry->start_slot = slot_id;
 1869                         et_entry->missing_count = missing_cnt;
 1870                         et_entry->phy_bits = phy_bits;
 1871 
 1872                         /*
 1873                          * Initialize all entries for this enclosure in the
 1874                          * mapping table and mark them as reserved. The actual
 1875                          * devices have not been processed yet but when they are
 1876                          * they will use these entries. If an entry is found
 1877                          * that already has a valid DPM index, the mapping table
 1878                          * is corrupt. This can happen if the mapping type is
 1879                          * changed without clearing all of the DPM entries in
 1880                          * the controller.
 1881                          */
 1882                         mt_entry = &sc->mapping_table[dev_idx];
 1883                         for (map_idx = dev_idx; map_idx < (dev_idx + num_slots);
 1884                             map_idx++, mt_entry++) {
 1885                                 if (mt_entry->dpm_entry_num !=
 1886                                     MPS_DPM_BAD_IDX) {
 1887                                         mps_dprint(sc, MPS_ERROR | MPS_MAPPING,
 1888                                             "%s: Conflict in mapping table for "
 1889                                             "enclosure %d device %d\n",
 1890                                             __func__, enc_idx, map_idx);
 1891                                         break;
 1892                                 }
 1893                                 physical_id =
 1894                                     dpm_entry->PhysicalIdentifier.High;
 1895                                 mt_entry->physical_id = (physical_id << 32) |
 1896                                     dpm_entry->PhysicalIdentifier.Low;
 1897                                 mt_entry->phy_bits = phy_bits;
 1898                                 mt_entry->id = dev_idx;
 1899                                 mt_entry->dpm_entry_num = entry_num;
 1900                                 mt_entry->missing_count = missing_cnt;
 1901                                 mt_entry->device_info = MPS_DEV_RESERVED;
 1902                         }
 1903                 } else if ((ioc_pg8_flags &
 1904                     MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) ==
 1905                     MPI2_IOCPAGE8_FLAGS_DEVICE_PERSISTENCE_MAPPING) {
 1906                         /*
 1907                          * Device mapping, so simply copy the DPM entries to the
 1908                          * mapping table, but check for a corrupt mapping table
 1909                          * (as described above in Enc/Slot mapping).
 1910                          */
 1911                         map_idx = dev_idx;
 1912                         mt_entry = &sc->mapping_table[map_idx];
 1913                         if (mt_entry->dpm_entry_num != MPS_DPM_BAD_IDX) {
 1914                                 mps_dprint(sc, MPS_ERROR | MPS_MAPPING, "%s: "
 1915                                     "Conflict in mapping table for device %d\n",
 1916                                     __func__, map_idx);
 1917                                 break;
 1918                         }
 1919                         physical_id = dpm_entry->PhysicalIdentifier.High;
 1920                         mt_entry->physical_id = (physical_id << 32) |
 1921                             dpm_entry->PhysicalIdentifier.Low;
 1922                         mt_entry->phy_bits = phy_bits;
 1923                         mt_entry->id = dev_idx;
 1924                         mt_entry->missing_count = missing_cnt;
 1925                         mt_entry->dpm_entry_num = entry_num;
 1926                         mt_entry->device_info = MPS_DEV_RESERVED;
 1927                 }
 1928         } /*close the loop for DPM table */
 1929 }
 1930 
 1931 /*
 1932  * mps_mapping_check_devices - start of the day check for device availabilty
 1933  * @sc: per adapter object
 1934  *
 1935  * Returns nothing.
 1936  */
 1937 void
 1938 mps_mapping_check_devices(void *data)
 1939 {
 1940         u32 i;
 1941         struct dev_mapping_table *mt_entry;
 1942         struct mps_softc *sc = (struct mps_softc *)data;
 1943         u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags);
 1944         struct enc_mapping_table *et_entry;
 1945         u32 start_idx = 0, end_idx = 0;
 1946         u8 stop_device_checks = 0;
 1947 
 1948         MPS_FUNCTRACE(sc);
 1949 
 1950         /*
 1951          * Clear this flag so that this function is never called again except
 1952          * within this function if the check needs to be done again. The
 1953          * purpose is to check for missing devices that are currently in the
 1954          * mapping table so do this only at driver init after discovery.
 1955          */
 1956         sc->track_mapping_events = 0;
 1957 
 1958         /*
 1959          * callout synchronization
 1960          * This is used to prevent race conditions for the callout. 
 1961          */
 1962         mps_dprint(sc, MPS_MAPPING, "%s: Start check for missing devices.\n",
 1963             __func__);
 1964         mtx_assert(&sc->mps_mtx, MA_OWNED);
 1965         if ((callout_pending(&sc->device_check_callout)) ||
 1966             (!callout_active(&sc->device_check_callout))) {
 1967                 mps_dprint(sc, MPS_MAPPING, "%s: Device Check Callout is "
 1968                     "already pending or not active.\n", __func__);
 1969                 return;
 1970         }
 1971         callout_deactivate(&sc->device_check_callout);
 1972 
 1973         /*
 1974          * Use callout to check if any devices in the mapping table have been
 1975          * processed yet. If ALL devices are marked as not init_complete, no
 1976          * devices have been processed and mapped. Until devices are mapped
 1977          * there's no reason to mark them as missing. Continue resetting this
 1978          * callout until devices have been mapped.
 1979          */
 1980         if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) ==
 1981             MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) {
 1982                 et_entry = sc->enclosure_table;
 1983                 for (i = 0; i < sc->num_enc_table_entries; i++, et_entry++) {
 1984                         if (et_entry->init_complete) {
 1985                                 stop_device_checks = 1;
 1986                                 break;
 1987                         }
 1988                 }
 1989         } else if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) ==
 1990             MPI2_IOCPAGE8_FLAGS_DEVICE_PERSISTENCE_MAPPING) {
 1991                 mt_entry = sc->mapping_table;
 1992                 for (i = 0; i < sc->max_devices; i++, mt_entry++) {
 1993                         if (mt_entry->init_complete) {
 1994                                 stop_device_checks = 1;
 1995                                 break;
 1996                         }
 1997                 }
 1998         }
 1999 
 2000         /*
 2001          * Setup another callout check after a delay. Keep doing this until
 2002          * devices are mapped.
 2003          */
 2004         if (!stop_device_checks) {
 2005                 mps_dprint(sc, MPS_MAPPING, "%s: No devices have been mapped. "
 2006                     "Reset callout to check again after a %d second delay.\n",
 2007                     __func__, MPS_MISSING_CHECK_DELAY);
 2008                 callout_reset(&sc->device_check_callout,
 2009                     MPS_MISSING_CHECK_DELAY * hz, mps_mapping_check_devices,
 2010                     sc);
 2011                 return;
 2012         }
 2013         mps_dprint(sc, MPS_MAPPING, "%s: Device check complete.\n", __func__);
 2014 
 2015         /*
 2016          * Depending on the mapping type, check if devices have been processed
 2017          * and update their missing counts if not processed.
 2018          */
 2019         if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) ==
 2020             MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING) {
 2021                 et_entry = sc->enclosure_table;
 2022                 for (i = 0; i < sc->num_enc_table_entries; i++, et_entry++) {
 2023                         if (!et_entry->init_complete) {
 2024                                 if (et_entry->missing_count <
 2025                                     MPS_MAX_MISSING_COUNT) {
 2026                                         mps_dprint(sc, MPS_MAPPING, "%s: "
 2027                                             "Enclosure %d is missing from the "
 2028                                             "topology. Update its missing "
 2029                                             "count.\n", __func__, i);
 2030                                         et_entry->missing_count++;
 2031                                         if (et_entry->dpm_entry_num !=
 2032                                             MPS_DPM_BAD_IDX) {
 2033                                                 _mapping_commit_enc_entry(sc,
 2034                                                     et_entry);
 2035                                         }
 2036                                 }
 2037                                 et_entry->init_complete = 1;
 2038                         }
 2039                 }
 2040                 if (!sc->ir_firmware)
 2041                         return;
 2042                 _mapping_get_ir_maprange(sc, &start_idx, &end_idx);
 2043                 mt_entry = &sc->mapping_table[start_idx];
 2044         } else if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) ==
 2045             MPI2_IOCPAGE8_FLAGS_DEVICE_PERSISTENCE_MAPPING) {
 2046                 start_idx = 0;
 2047                 end_idx = sc->max_devices - 1;
 2048                 mt_entry = sc->mapping_table;
 2049         }
 2050 
 2051         /*
 2052          * The start and end indices have been set above according to the
 2053          * mapping type. Go through these mappings and update any entries that
 2054          * do not have the init_complete flag set, which means they are missing.
 2055          */
 2056         if (end_idx == 0)
 2057                 return;
 2058         for (i = start_idx; i < (end_idx + 1); i++, mt_entry++) {
 2059                 if (mt_entry->device_info & MPS_DEV_RESERVED
 2060                     && !mt_entry->physical_id)
 2061                         mt_entry->init_complete = 1;
 2062                 else if (mt_entry->device_info & MPS_DEV_RESERVED) {
 2063                         if (!mt_entry->init_complete) {
 2064                                 mps_dprint(sc, MPS_MAPPING, "%s: Device in "
 2065                                     "mapping table at index %d is missing from "
 2066                                     "topology. Update its missing count.\n",
 2067                                     __func__, i);
 2068                                 if (mt_entry->missing_count <
 2069                                     MPS_MAX_MISSING_COUNT) {
 2070                                         mt_entry->missing_count++;
 2071                                         if (mt_entry->dpm_entry_num !=
 2072                                             MPS_DPM_BAD_IDX) {
 2073                                                 _mapping_commit_map_entry(sc,
 2074                                                     mt_entry);
 2075                                         }
 2076                                 }
 2077                                 mt_entry->init_complete = 1;
 2078                         }
 2079                 }
 2080         }
 2081 }
 2082 
 2083 /**
 2084  * mps_mapping_initialize - initialize mapping tables
 2085  * @sc: per adapter object
 2086  *
 2087  * Read controller persitant mapping tables into internal data area.
 2088  *
 2089  * Return 0 for success or non-zero for failure.
 2090  */
 2091 int
 2092 mps_mapping_initialize(struct mps_softc *sc)
 2093 {
 2094         uint16_t volume_mapping_flags, dpm_pg0_sz;
 2095         uint32_t i;
 2096         Mpi2ConfigReply_t mpi_reply;
 2097         int error;
 2098         uint8_t retry_count;
 2099         uint16_t ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags);
 2100 
 2101         /* The additional 1 accounts for the virtual enclosure
 2102          * created for the controller
 2103          */
 2104         sc->max_enclosures = sc->facts->MaxEnclosures + 1;
 2105         sc->max_expanders = sc->facts->MaxSasExpanders;
 2106         sc->max_volumes = sc->facts->MaxVolumes;
 2107         sc->max_devices = sc->facts->MaxTargets + sc->max_volumes;
 2108         sc->pending_map_events = 0;
 2109         sc->num_enc_table_entries = 0;
 2110         sc->num_rsvd_entries = 0;
 2111         sc->max_dpm_entries = sc->ioc_pg8.MaxPersistentEntries;
 2112         sc->is_dpm_enable = (sc->max_dpm_entries) ? 1 : 0;
 2113         sc->track_mapping_events = 0;
 2114 
 2115         mps_dprint(sc, MPS_MAPPING, "%s: Mapping table has a max of %d entries "
 2116             "and DPM has a max of %d entries.\n", __func__, sc->max_devices,
 2117             sc->max_dpm_entries);
 2118         if (ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_DISABLE_PERSISTENT_MAPPING)
 2119                 sc->is_dpm_enable = 0;
 2120 
 2121         if (ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_RESERVED_TARGETID_0)
 2122                 sc->num_rsvd_entries = 1;
 2123 
 2124         volume_mapping_flags = sc->ioc_pg8.IRVolumeMappingFlags &
 2125             MPI2_IOCPAGE8_IRFLAGS_MASK_VOLUME_MAPPING_MODE;
 2126         if (sc->ir_firmware && (volume_mapping_flags ==
 2127             MPI2_IOCPAGE8_IRFLAGS_LOW_VOLUME_MAPPING))
 2128                 sc->num_rsvd_entries += sc->max_volumes;
 2129 
 2130         error = mps_mapping_allocate_memory(sc);
 2131         if (error)
 2132                 return (error);
 2133 
 2134         for (i = 0; i < sc->max_devices; i++)
 2135                 _mapping_clear_map_entry(sc->mapping_table + i);
 2136 
 2137         for (i = 0; i < sc->max_enclosures; i++)
 2138                 _mapping_clear_enc_entry(sc->enclosure_table + i);
 2139 
 2140         for (i = 0; i < sc->max_devices; i++) {
 2141                 sc->removal_table[i].dev_handle = 0;
 2142                 sc->removal_table[i].dpm_entry_num = MPS_DPM_BAD_IDX;
 2143         }
 2144 
 2145         memset(sc->dpm_entry_used, 0, sc->max_dpm_entries);
 2146         memset(sc->dpm_flush_entry, 0, sc->max_dpm_entries);
 2147 
 2148         if (sc->is_dpm_enable) {
 2149                 dpm_pg0_sz = sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER) +
 2150                     (sc->max_dpm_entries *
 2151                      sizeof(MPI2_CONFIG_PAGE_DRIVER_MAP0_ENTRY));
 2152                 retry_count = 0;
 2153 
 2154 retry_read_dpm:
 2155                 if (mps_config_get_dpm_pg0(sc, &mpi_reply, sc->dpm_pg0,
 2156                     dpm_pg0_sz)) {
 2157                         mps_dprint(sc, MPS_ERROR | MPS_MAPPING, "%s: DPM page "
 2158                             "read failed.\n", __func__);
 2159                         if (retry_count < 3) {
 2160                                 retry_count++;
 2161                                 goto retry_read_dpm;
 2162                         }
 2163                         sc->is_dpm_enable = 0;
 2164                 }
 2165         }
 2166 
 2167         if (sc->is_dpm_enable)
 2168                 _mapping_process_dpm_pg0(sc);
 2169         else {
 2170                 mps_dprint(sc, MPS_MAPPING, "%s: DPM processing is disabled. "
 2171                     "Device mappings will not persist across reboots or "
 2172                     "resets.\n", __func__);
 2173         }
 2174 
 2175         sc->track_mapping_events = 1;
 2176         return 0;
 2177 }
 2178 
 2179 /**
 2180  * mps_mapping_exit - clear mapping table and associated memory
 2181  * @sc: per adapter object
 2182  *
 2183  * Returns nothing.
 2184  */
 2185 void
 2186 mps_mapping_exit(struct mps_softc *sc)
 2187 {
 2188         _mapping_flush_dpm_pages(sc);
 2189         mps_mapping_free_memory(sc);
 2190 }
 2191 
 2192 /**
 2193  * mps_mapping_get_tid - return the target id for sas device and handle
 2194  * @sc: per adapter object
 2195  * @sas_address: sas address of the device
 2196  * @handle: device handle
 2197  *
 2198  * Returns valid target ID on success or BAD_ID.
 2199  */
 2200 unsigned int
 2201 mps_mapping_get_tid(struct mps_softc *sc, uint64_t sas_address, u16 handle)
 2202 {
 2203         u32 map_idx;
 2204         struct dev_mapping_table *mt_entry;
 2205 
 2206         for (map_idx = 0; map_idx < sc->max_devices; map_idx++) {
 2207                 mt_entry = &sc->mapping_table[map_idx];
 2208                 if (mt_entry->dev_handle == handle && mt_entry->physical_id ==
 2209                     sas_address)
 2210                         return mt_entry->id;
 2211         }
 2212 
 2213         return MPS_MAP_BAD_ID;
 2214 }
 2215 
 2216 /**
 2217  * mps_mapping_get_tid_from_handle - find a target id in mapping table using
 2218  * only the dev handle.  This is just a wrapper function for the local function
 2219  * _mapping_get_mt_idx_from_handle.
 2220  * @sc: per adapter object
 2221  * @handle: device handle
 2222  *
 2223  * Returns valid target ID on success or BAD_ID.
 2224  */
 2225 unsigned int
 2226 mps_mapping_get_tid_from_handle(struct mps_softc *sc, u16 handle)
 2227 {
 2228         return (_mapping_get_mt_idx_from_handle(sc, handle));
 2229 }
 2230 
 2231 /**
 2232  * mps_mapping_get_raid_tid - return the target id for raid device
 2233  * @sc: per adapter object
 2234  * @wwid: world wide identifier for raid volume
 2235  * @volHandle: volume device handle
 2236  *
 2237  * Returns valid target ID on success or BAD_ID.
 2238  */
 2239 unsigned int
 2240 mps_mapping_get_raid_tid(struct mps_softc *sc, u64 wwid, u16 volHandle)
 2241 {
 2242         u32 start_idx, end_idx, map_idx;
 2243         struct dev_mapping_table *mt_entry;
 2244 
 2245         _mapping_get_ir_maprange(sc, &start_idx, &end_idx);
 2246         mt_entry = &sc->mapping_table[start_idx];
 2247         for (map_idx  = start_idx; map_idx <= end_idx; map_idx++, mt_entry++) {
 2248                 if (mt_entry->dev_handle == volHandle &&
 2249                     mt_entry->physical_id == wwid)
 2250                         return mt_entry->id;
 2251         }
 2252 
 2253         return MPS_MAP_BAD_ID;
 2254 }
 2255 
 2256 /**
 2257  * mps_mapping_get_raid_tid_from_handle - find raid device in mapping table
 2258  * using only the volume dev handle.  This is just a wrapper function for the
 2259  * local function _mapping_get_ir_mt_idx_from_handle.
 2260  * @sc: per adapter object
 2261  * @volHandle: volume device handle
 2262  *
 2263  * Returns valid target ID on success or BAD_ID.
 2264  */
 2265 unsigned int
 2266 mps_mapping_get_raid_tid_from_handle(struct mps_softc *sc, u16 volHandle)
 2267 {
 2268         return (_mapping_get_ir_mt_idx_from_handle(sc, volHandle));
 2269 }
 2270 
 2271 /**
 2272  * mps_mapping_enclosure_dev_status_change_event - handle enclosure events
 2273  * @sc: per adapter object
 2274  * @event_data: event data payload
 2275  *
 2276  * Return nothing.
 2277  */
 2278 void
 2279 mps_mapping_enclosure_dev_status_change_event(struct mps_softc *sc,
 2280     Mpi2EventDataSasEnclDevStatusChange_t *event_data)
 2281 {
 2282         u8 enc_idx, missing_count;
 2283         struct enc_mapping_table *et_entry;
 2284         Mpi2DriverMap0Entry_t *dpm_entry;
 2285         u16 ioc_pg8_flags = le16toh(sc->ioc_pg8.Flags);
 2286         u8 map_shift = MPI2_DRVMAP0_MAPINFO_SLOT_SHIFT;
 2287         u8 update_phy_bits = 0;
 2288         u32 saved_phy_bits;
 2289         uint64_t temp64_var;
 2290 
 2291         if ((ioc_pg8_flags & MPI2_IOCPAGE8_FLAGS_MASK_MAPPING_MODE) !=
 2292             MPI2_IOCPAGE8_FLAGS_ENCLOSURE_SLOT_MAPPING)
 2293                 goto out;
 2294 
 2295         dpm_entry = (Mpi2DriverMap0Entry_t *)((u8 *)sc->dpm_pg0 +
 2296             sizeof(MPI2_CONFIG_EXTENDED_PAGE_HEADER));
 2297 
 2298         if (event_data->ReasonCode == MPI2_EVENT_SAS_ENCL_RC_ADDED) {
 2299                 if (!event_data->NumSlots) {
 2300                         mps_dprint(sc, MPS_ERROR | MPS_MAPPING, "%s: Enclosure "
 2301                             "with handle = 0x%x reported 0 slots.\n", __func__,
 2302                             le16toh(event_data->EnclosureHandle));
 2303                         goto out;
 2304                 }
 2305                 temp64_var = event_data->EnclosureLogicalID.High;
 2306                 temp64_var = (temp64_var << 32) |
 2307                     event_data->EnclosureLogicalID.Low;
 2308                 enc_idx = _mapping_get_enc_idx_from_id(sc, temp64_var,
 2309                     event_data->PhyBits);
 2310 
 2311                 /*
 2312                  * If the Added enclosure is already in the Enclosure Table,
 2313                  * make sure that all the enclosure info is up to date. If
 2314                  * the enclosure was missing and has just been added back, or if
 2315                  * the enclosure's Phy Bits have changed, clear the missing
 2316                  * count and update the Phy Bits in the mapping table and in the
 2317                  * DPM, if it's being used.
 2318                  */
 2319                 if (enc_idx != MPS_ENCTABLE_BAD_IDX) {
 2320                         et_entry = &sc->enclosure_table[enc_idx];
 2321                         if (et_entry->init_complete &&
 2322                             !et_entry->missing_count) {
 2323                                 mps_dprint(sc, MPS_MAPPING, "%s: Enclosure %d "
 2324                                     "is already present with handle = 0x%x\n",
 2325                                     __func__, enc_idx, et_entry->enc_handle);
 2326                                 goto out;
 2327                         }
 2328                         et_entry->enc_handle = le16toh(event_data->
 2329                             EnclosureHandle);
 2330                         et_entry->start_slot = le16toh(event_data->StartSlot);
 2331                         saved_phy_bits = et_entry->phy_bits;
 2332                         et_entry->phy_bits |= le32toh(event_data->PhyBits);
 2333                         if (saved_phy_bits != et_entry->phy_bits)
 2334                                 update_phy_bits = 1;
 2335                         if (et_entry->missing_count || update_phy_bits) {
 2336                                 et_entry->missing_count = 0;
 2337                                 if (sc->is_dpm_enable &&
 2338                                     et_entry->dpm_entry_num !=
 2339                                     MPS_DPM_BAD_IDX) {
 2340                                         dpm_entry += et_entry->dpm_entry_num;
 2341                                         missing_count =
 2342                                             (u8)(dpm_entry->MappingInformation &
 2343                                             MPI2_DRVMAP0_MAPINFO_MISSING_MASK);
 2344                                         if (missing_count || update_phy_bits) {
 2345                                                 dpm_entry->MappingInformation
 2346                                                     = et_entry->num_slots;
 2347                                                 dpm_entry->MappingInformation
 2348                                                     <<= map_shift;
 2349                                                 dpm_entry->PhysicalBitsMapping
 2350                                                     = et_entry->phy_bits;
 2351                                                 sc->dpm_flush_entry[et_entry->
 2352                                                     dpm_entry_num] = 1;
 2353                                         }
 2354                                 }
 2355                         }
 2356                 } else {
 2357                         /*
 2358                          * This is a new enclosure that is being added.
 2359                          * Initialize the Enclosure Table entry. It will be
 2360                          * finalized when a device is added for the enclosure
 2361                          * and the enclosure has enough space in the Mapping
 2362                          * Table to map its devices.
 2363                          */
 2364                         if (sc->num_enc_table_entries < sc->max_enclosures) {
 2365                                 enc_idx = sc->num_enc_table_entries;
 2366                                 sc->num_enc_table_entries++;
 2367                         } else {
 2368                                 enc_idx = _mapping_get_high_missing_et_idx(sc);
 2369                                 if (enc_idx != MPS_ENCTABLE_BAD_IDX) {
 2370                                         et_entry = &sc->enclosure_table[enc_idx];
 2371                                         _mapping_add_to_removal_table(sc,
 2372                                             et_entry->dpm_entry_num);
 2373                                         _mapping_clear_enc_entry(et_entry);
 2374                                 }
 2375                         }
 2376                         if (enc_idx == MPS_ENCTABLE_BAD_IDX) {
 2377                                 mps_dprint(sc, MPS_ERROR | MPS_MAPPING, "%s: "
 2378                                     "Enclosure cannot be added to mapping "
 2379                                     "table because it's full.\n", __func__);
 2380                                 goto out;
 2381                         }
 2382                         et_entry = &sc->enclosure_table[enc_idx];
 2383                         et_entry->enc_handle = le16toh(event_data->
 2384                             EnclosureHandle);
 2385                         et_entry->enclosure_id = le64toh(event_data->
 2386                             EnclosureLogicalID.High);
 2387                         et_entry->enclosure_id =
 2388                             ((et_entry->enclosure_id << 32) |
 2389                             le64toh(event_data->EnclosureLogicalID.Low));
 2390                         et_entry->start_index = MPS_MAPTABLE_BAD_IDX;
 2391                         et_entry->dpm_entry_num = MPS_DPM_BAD_IDX;
 2392                         et_entry->num_slots = le16toh(event_data->NumSlots);
 2393                         et_entry->start_slot = le16toh(event_data->StartSlot);
 2394                         et_entry->phy_bits = le32toh(event_data->PhyBits);
 2395                 }
 2396                 et_entry->init_complete = 1;
 2397         } else if (event_data->ReasonCode ==
 2398             MPI2_EVENT_SAS_ENCL_RC_NOT_RESPONDING) {
 2399                 /*
 2400                  * An enclosure was removed. Update its missing count and then
 2401                  * update the DPM entry with the new missing count for the
 2402                  * enclosure.
 2403                  */
 2404                 enc_idx = _mapping_get_enc_idx_from_handle(sc,
 2405                     le16toh(event_data->EnclosureHandle));
 2406                 if (enc_idx == MPS_ENCTABLE_BAD_IDX) {
 2407                         mps_dprint(sc, MPS_ERROR | MPS_MAPPING, "%s: Cannot "
 2408                             "unmap enclosure with handle 0x%04x because it "
 2409                             "has already been deleted.\n", __func__,
 2410                             le16toh(event_data->EnclosureHandle));
 2411                         goto out;
 2412                 }
 2413                 et_entry = &sc->enclosure_table[enc_idx];
 2414                 if (et_entry->missing_count < MPS_MAX_MISSING_COUNT)
 2415                         et_entry->missing_count++;
 2416                 if (sc->is_dpm_enable &&
 2417                     et_entry->dpm_entry_num != MPS_DPM_BAD_IDX) {
 2418                         dpm_entry += et_entry->dpm_entry_num;
 2419                         dpm_entry->MappingInformation = et_entry->num_slots;
 2420                         dpm_entry->MappingInformation <<= map_shift;
 2421                         dpm_entry->MappingInformation |=
 2422                             et_entry->missing_count;
 2423                         sc->dpm_flush_entry[et_entry->dpm_entry_num] = 1;
 2424                 }
 2425                 et_entry->init_complete = 1;
 2426         }
 2427 
 2428 out:
 2429         _mapping_flush_dpm_pages(sc);
 2430         if (sc->pending_map_events)
 2431                 sc->pending_map_events--;
 2432 }
 2433 
 2434 /**
 2435  * mps_mapping_topology_change_event - handle topology change events
 2436  * @sc: per adapter object
 2437  * @event_data: event data payload
 2438  *
 2439  * Returns nothing.
 2440  */
 2441 void
 2442 mps_mapping_topology_change_event(struct mps_softc *sc,
 2443     Mpi2EventDataSasTopologyChangeList_t *event_data)
 2444 {
 2445         struct _map_topology_change topo_change;
 2446         struct _map_phy_change *phy_change;
 2447         Mpi2EventSasTopoPhyEntry_t *event_phy_change;
 2448         u8 i, num_entries;
 2449 
 2450         topo_change.enc_handle = le16toh(event_data->EnclosureHandle);
 2451         topo_change.exp_handle = le16toh(event_data->ExpanderDevHandle);
 2452         num_entries = event_data->NumEntries;
 2453         topo_change.num_entries = num_entries;
 2454         topo_change.start_phy_num = event_data->StartPhyNum;
 2455         topo_change.num_phys = event_data->NumPhys;
 2456         topo_change.exp_status = event_data->ExpStatus;
 2457         event_phy_change = event_data->PHY;
 2458         topo_change.phy_details = NULL;
 2459 
 2460         if (!num_entries)
 2461                 goto out;
 2462         phy_change = malloc(sizeof(struct _map_phy_change) * num_entries,
 2463             M_MPT2, M_NOWAIT|M_ZERO);
 2464         topo_change.phy_details = phy_change;
 2465         if (!phy_change)
 2466                 goto out;
 2467         for (i = 0; i < num_entries; i++, event_phy_change++, phy_change++) {
 2468                 phy_change->dev_handle = le16toh(event_phy_change->
 2469                     AttachedDevHandle);
 2470                 phy_change->reason = event_phy_change->PhyStatus &
 2471                     MPI2_EVENT_SAS_TOPO_RC_MASK;
 2472         }
 2473         _mapping_update_missing_count(sc, &topo_change);
 2474         _mapping_get_dev_info(sc, &topo_change);
 2475         _mapping_clear_removed_entries(sc);
 2476         _mapping_add_new_device(sc, &topo_change);
 2477 
 2478 out:
 2479         free(topo_change.phy_details, M_MPT2);
 2480         _mapping_flush_dpm_pages(sc);
 2481         if (sc->pending_map_events)
 2482                 sc->pending_map_events--;
 2483 }
 2484 
 2485 /**
 2486  * mps_mapping_ir_config_change_event - handle IR config change list events
 2487  * @sc: per adapter object
 2488  * @event_data: event data payload
 2489  *
 2490  * Returns nothing.
 2491  */
 2492 void
 2493 mps_mapping_ir_config_change_event(struct mps_softc *sc,
 2494     Mpi2EventDataIrConfigChangeList_t *event_data)
 2495 {
 2496         Mpi2EventIrConfigElement_t *element;
 2497         int i;
 2498         u64 *wwid_table;
 2499         u32 map_idx, flags;
 2500         struct dev_mapping_table *mt_entry;
 2501         u16 element_flags;
 2502 
 2503         wwid_table = malloc(sizeof(u64) * event_data->NumElements, M_MPT2,
 2504             M_NOWAIT | M_ZERO);
 2505         if (!wwid_table)
 2506                 goto out;
 2507         element = (Mpi2EventIrConfigElement_t *)&event_data->ConfigElement[0];
 2508         flags = le32toh(event_data->Flags);
 2509 
 2510         /*
 2511          * For volume changes, get the WWID for the volume and put it in a
 2512          * table to be used in the processing of the IR change event.
 2513          */
 2514         for (i = 0; i < event_data->NumElements; i++, element++) {
 2515                 element_flags = le16toh(element->ElementFlags);
 2516                 if ((element->ReasonCode != MPI2_EVENT_IR_CHANGE_RC_ADDED) &&
 2517                     (element->ReasonCode != MPI2_EVENT_IR_CHANGE_RC_REMOVED) &&
 2518                     (element->ReasonCode != MPI2_EVENT_IR_CHANGE_RC_NO_CHANGE)
 2519                     && (element->ReasonCode !=
 2520                         MPI2_EVENT_IR_CHANGE_RC_VOLUME_CREATED))
 2521                         continue;
 2522                 if ((element_flags &
 2523                     MPI2_EVENT_IR_CHANGE_EFLAGS_ELEMENT_TYPE_MASK) ==
 2524                     MPI2_EVENT_IR_CHANGE_EFLAGS_VOLUME_ELEMENT) {
 2525                         mps_config_get_volume_wwid(sc,
 2526                             le16toh(element->VolDevHandle), &wwid_table[i]);
 2527                 }
 2528         }
 2529 
 2530         /*
 2531          * Check the ReasonCode for each element in the IR event and Add/Remove
 2532          * Volumes or Physical Disks of Volumes to/from the mapping table. Use
 2533          * the WWIDs gotten above in wwid_table.
 2534          */
 2535         if (flags == MPI2_EVENT_IR_CHANGE_FLAGS_FOREIGN_CONFIG)
 2536                 goto out;
 2537         else {
 2538                 element = (Mpi2EventIrConfigElement_t *)&event_data->
 2539                     ConfigElement[0];
 2540                 for (i = 0; i < event_data->NumElements; i++, element++) {
 2541                         if (element->ReasonCode ==
 2542                             MPI2_EVENT_IR_CHANGE_RC_ADDED ||
 2543                             element->ReasonCode ==
 2544                             MPI2_EVENT_IR_CHANGE_RC_VOLUME_CREATED) {
 2545                                 map_idx = _mapping_get_ir_mt_idx_from_wwid
 2546                                     (sc, wwid_table[i]);
 2547                                 if (map_idx != MPS_MAPTABLE_BAD_IDX) {
 2548                                         /*
 2549                                          * The volume is already in the mapping
 2550                                          * table. Just update it's info.
 2551                                          */
 2552                                         mt_entry = &sc->mapping_table[map_idx];
 2553                                         mt_entry->id = map_idx;
 2554                                         mt_entry->dev_handle = le16toh
 2555                                             (element->VolDevHandle);
 2556                                         mt_entry->device_info =
 2557                                             MPS_DEV_RESERVED | MPS_MAP_IN_USE;
 2558                                         _mapping_update_ir_missing_cnt(sc,
 2559                                             map_idx, element, wwid_table[i]);
 2560                                         continue;
 2561                                 }
 2562 
 2563                                 /*
 2564                                  * Volume is not in mapping table yet. Find a
 2565                                  * free entry in the mapping table at the
 2566                                  * volume mapping locations. If no entries are
 2567                                  * available, this is an error because it means
 2568                                  * there are more volumes than can be mapped
 2569                                  * and that should never happen for volumes.
 2570                                  */
 2571                                 map_idx = _mapping_get_free_ir_mt_idx(sc);
 2572                                 if (map_idx == MPS_MAPTABLE_BAD_IDX)
 2573                                 {
 2574                                         mps_dprint(sc, MPS_ERROR | MPS_MAPPING,
 2575                                             "%s: failed to add the volume with "
 2576                                             "handle 0x%04x because there is no "
 2577                                             "free space available in the "
 2578                                             "mapping table\n", __func__,
 2579                                             le16toh(element->VolDevHandle));
 2580                                         continue;
 2581                                 }
 2582                                 mt_entry = &sc->mapping_table[map_idx];
 2583                                 mt_entry->physical_id = wwid_table[i];
 2584                                 mt_entry->id = map_idx;
 2585                                 mt_entry->dev_handle = le16toh(element->
 2586                                     VolDevHandle);
 2587                                 mt_entry->device_info = MPS_DEV_RESERVED |
 2588                                     MPS_MAP_IN_USE;
 2589                                 _mapping_update_ir_missing_cnt(sc, map_idx,
 2590                                     element, wwid_table[i]);
 2591                         } else if (element->ReasonCode ==
 2592                             MPI2_EVENT_IR_CHANGE_RC_REMOVED) {
 2593                                 map_idx = _mapping_get_ir_mt_idx_from_wwid(sc,
 2594                                     wwid_table[i]);
 2595                                 if (map_idx == MPS_MAPTABLE_BAD_IDX) {
 2596                                         mps_dprint(sc, MPS_MAPPING,"%s: Failed "
 2597                                             "to remove a volume because it has "
 2598                                             "already been removed.\n",
 2599                                             __func__);
 2600                                         continue;
 2601                                 }
 2602                                 _mapping_update_ir_missing_cnt(sc, map_idx,
 2603                                     element, wwid_table[i]);
 2604                         } else if (element->ReasonCode ==
 2605                             MPI2_EVENT_IR_CHANGE_RC_VOLUME_DELETED) {
 2606                                 map_idx = _mapping_get_mt_idx_from_handle(sc,
 2607                                     le16toh(element->VolDevHandle));
 2608                                 if (map_idx == MPS_MAPTABLE_BAD_IDX) {
 2609                                         mps_dprint(sc, MPS_MAPPING,"%s: Failed "
 2610                                             "to remove volume with handle "
 2611                                             "0x%04x because it has already "
 2612                                             "been removed.\n", __func__,
 2613                                             le16toh(element->VolDevHandle));
 2614                                         continue;
 2615                                 }
 2616                                 mt_entry = &sc->mapping_table[map_idx];
 2617                                 _mapping_update_ir_missing_cnt(sc, map_idx,
 2618                                     element, mt_entry->physical_id);
 2619                         }
 2620                 }
 2621         }
 2622 
 2623 out:
 2624         _mapping_flush_dpm_pages(sc);
 2625         free(wwid_table, M_MPT2);
 2626         if (sc->pending_map_events)
 2627                 sc->pending_map_events--;
 2628 }
 2629 
 2630 int
 2631 mps_mapping_dump(SYSCTL_HANDLER_ARGS)
 2632 {
 2633         struct mps_softc *sc;
 2634         struct dev_mapping_table *mt_entry;
 2635         struct sbuf sbuf;
 2636         int i, error;
 2637 
 2638         sc = (struct mps_softc *)arg1;
 2639 
 2640         error = sysctl_wire_old_buffer(req, 0);
 2641         if (error != 0)
 2642                 return (error);
 2643         sbuf_new_for_sysctl(&sbuf, NULL, 128, req);
 2644 
 2645         sbuf_printf(&sbuf, "\nindex physical_id       handle id\n");
 2646         for (i = 0; i < sc->max_devices; i++) {
 2647                 mt_entry = &sc->mapping_table[i];
 2648                 if (mt_entry->physical_id == 0)
 2649                         continue;
 2650                 sbuf_printf(&sbuf, "%4d  %jx  %04x   %hd\n",
 2651                     i, mt_entry->physical_id, mt_entry->dev_handle,
 2652                     mt_entry->id);
 2653         }
 2654         error = sbuf_finish(&sbuf);
 2655         sbuf_delete(&sbuf);
 2656         return (error);
 2657 }
 2658 
 2659 int
 2660 mps_mapping_encl_dump(SYSCTL_HANDLER_ARGS)
 2661 {
 2662         struct mps_softc *sc;
 2663         struct enc_mapping_table *enc_entry;
 2664         struct sbuf sbuf;
 2665         int i, error;
 2666 
 2667         sc = (struct mps_softc *)arg1;
 2668 
 2669         error = sysctl_wire_old_buffer(req, 0);
 2670         if (error != 0)
 2671                 return (error);
 2672         sbuf_new_for_sysctl(&sbuf, NULL, 128, req);
 2673 
 2674         sbuf_printf(&sbuf, "\nindex enclosure_id      handle map_index\n");
 2675         for (i = 0; i < sc->max_enclosures; i++) {
 2676                 enc_entry = &sc->enclosure_table[i];
 2677                 if (enc_entry->enclosure_id == 0)
 2678                         continue;
 2679                 sbuf_printf(&sbuf, "%4d  %jx  %04x   %d\n",
 2680                     i, enc_entry->enclosure_id, enc_entry->enc_handle,
 2681                     enc_entry->start_index);
 2682         }
 2683         error = sbuf_finish(&sbuf);
 2684         sbuf_delete(&sbuf);
 2685         return (error);
 2686 }

Cache object: 6bed667d31afcc54e17599e367a4bb01


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.