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