xref: /freebsd/sys/cam/scsi/scsi_enc_ses.c (revision 24a1ba911069e79956ab268b32d3f4bcc72425f4)
1f6ad3f23SAlexander Motin /*-
2f6ad3f23SAlexander Motin  * Copyright (c) 2000 Matthew Jacob
3f6ad3f23SAlexander Motin  * Copyright (c) 2010 Spectra Logic Corporation
4f6ad3f23SAlexander Motin  * All rights reserved.
5f6ad3f23SAlexander Motin  *
6f6ad3f23SAlexander Motin  * Redistribution and use in source and binary forms, with or without
7f6ad3f23SAlexander Motin  * modification, are permitted provided that the following conditions
8f6ad3f23SAlexander Motin  * are met:
9f6ad3f23SAlexander Motin  * 1. Redistributions of source code must retain the above copyright
10f6ad3f23SAlexander Motin  *    notice, this list of conditions, and the following disclaimer,
11f6ad3f23SAlexander Motin  *    without modification, immediately at the beginning of the file.
12f6ad3f23SAlexander Motin  * 2. The name of the author may not be used to endorse or promote products
13f6ad3f23SAlexander Motin  *    derived from this software without specific prior written permission.
14f6ad3f23SAlexander Motin  *
15f6ad3f23SAlexander Motin  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16f6ad3f23SAlexander Motin  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17f6ad3f23SAlexander Motin  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18f6ad3f23SAlexander Motin  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
19f6ad3f23SAlexander Motin  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20f6ad3f23SAlexander Motin  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21f6ad3f23SAlexander Motin  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22f6ad3f23SAlexander Motin  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23f6ad3f23SAlexander Motin  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24f6ad3f23SAlexander Motin  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25f6ad3f23SAlexander Motin  * SUCH DAMAGE.
26f6ad3f23SAlexander Motin  */
27f6ad3f23SAlexander Motin 
28f6ad3f23SAlexander Motin /**
29f6ad3f23SAlexander Motin  * \file scsi_enc_ses.c
30f6ad3f23SAlexander Motin  *
31f6ad3f23SAlexander Motin  * Structures and routines specific && private to SES only
32f6ad3f23SAlexander Motin  */
33f6ad3f23SAlexander Motin 
34f6ad3f23SAlexander Motin #include <sys/cdefs.h>
35f6ad3f23SAlexander Motin __FBSDID("$FreeBSD$");
36f6ad3f23SAlexander Motin 
37f6ad3f23SAlexander Motin #include <sys/param.h>
38f6ad3f23SAlexander Motin 
39f6ad3f23SAlexander Motin #include <sys/errno.h>
40f6ad3f23SAlexander Motin #include <sys/kernel.h>
41f6ad3f23SAlexander Motin #include <sys/lock.h>
42f6ad3f23SAlexander Motin #include <sys/malloc.h>
43f6ad3f23SAlexander Motin #include <sys/mutex.h>
44f6ad3f23SAlexander Motin #include <sys/queue.h>
45f6ad3f23SAlexander Motin #include <sys/sbuf.h>
46f6ad3f23SAlexander Motin #include <sys/sx.h>
47f6ad3f23SAlexander Motin #include <sys/systm.h>
48f6ad3f23SAlexander Motin #include <sys/types.h>
49f6ad3f23SAlexander Motin 
50f6ad3f23SAlexander Motin #include <cam/cam.h>
51f6ad3f23SAlexander Motin #include <cam/cam_ccb.h>
52f6ad3f23SAlexander Motin #include <cam/cam_xpt_periph.h>
53f6ad3f23SAlexander Motin #include <cam/cam_periph.h>
54f6ad3f23SAlexander Motin 
55f6ad3f23SAlexander Motin #include <cam/scsi/scsi_message.h>
56f6ad3f23SAlexander Motin #include <cam/scsi/scsi_enc.h>
57f6ad3f23SAlexander Motin #include <cam/scsi/scsi_enc_internal.h>
58f6ad3f23SAlexander Motin 
59f6ad3f23SAlexander Motin /* SES Native Type Device Support */
60f6ad3f23SAlexander Motin 
61f6ad3f23SAlexander Motin /* SES Diagnostic Page Codes */
62f6ad3f23SAlexander Motin typedef enum {
63f6ad3f23SAlexander Motin 	SesSupportedPages	= 0x0,
64f6ad3f23SAlexander Motin 	SesConfigPage		= 0x1,
65f6ad3f23SAlexander Motin 	SesControlPage		= 0x2,
66f6ad3f23SAlexander Motin 	SesStatusPage		= SesControlPage,
67f6ad3f23SAlexander Motin 	SesHelpTxt		= 0x3,
68f6ad3f23SAlexander Motin 	SesStringOut		= 0x4,
69f6ad3f23SAlexander Motin 	SesStringIn		= SesStringOut,
70f6ad3f23SAlexander Motin 	SesThresholdOut		= 0x5,
71f6ad3f23SAlexander Motin 	SesThresholdIn		= SesThresholdOut,
72f6ad3f23SAlexander Motin 	SesArrayControl		= 0x6,	/* Obsolete in SES v2 */
73f6ad3f23SAlexander Motin 	SesArrayStatus		= SesArrayControl,
74f6ad3f23SAlexander Motin 	SesElementDescriptor	= 0x7,
75f6ad3f23SAlexander Motin 	SesShortStatus		= 0x8,
76f6ad3f23SAlexander Motin 	SesEnclosureBusy	= 0x9,
77f6ad3f23SAlexander Motin 	SesAddlElementStatus	= 0xa
78f6ad3f23SAlexander Motin } SesDiagPageCodes;
79f6ad3f23SAlexander Motin 
80f6ad3f23SAlexander Motin typedef struct ses_type {
81f6ad3f23SAlexander Motin 	const struct ses_elm_type_desc  *hdr;
82f6ad3f23SAlexander Motin 	const char			*text;
83f6ad3f23SAlexander Motin } ses_type_t;
84f6ad3f23SAlexander Motin 
85f6ad3f23SAlexander Motin typedef struct ses_comstat {
86f6ad3f23SAlexander Motin 	uint8_t	comstatus;
87f6ad3f23SAlexander Motin 	uint8_t	comstat[3];
88f6ad3f23SAlexander Motin } ses_comstat_t;
89f6ad3f23SAlexander Motin 
90f6ad3f23SAlexander Motin typedef union ses_addl_data {
91f6ad3f23SAlexander Motin 	struct ses_elm_sas_device_phy *sasdev_phys;
92f6ad3f23SAlexander Motin 	struct ses_elm_sas_expander_phy *sasexp_phys;
93f6ad3f23SAlexander Motin 	struct ses_elm_sas_port_phy *sasport_phys;
94f6ad3f23SAlexander Motin 	struct ses_fcobj_port *fc_ports;
95f6ad3f23SAlexander Motin } ses_add_data_t;
96f6ad3f23SAlexander Motin 
97f6ad3f23SAlexander Motin typedef struct ses_addl_status {
98f6ad3f23SAlexander Motin 	struct ses_elm_addlstatus_base_hdr *hdr;
99f6ad3f23SAlexander Motin 	union {
100f6ad3f23SAlexander Motin 		union ses_fcobj_hdr *fc;
101f6ad3f23SAlexander Motin 		union ses_elm_sas_hdr *sas;
102f6ad3f23SAlexander Motin 	} proto_hdr;
103f6ad3f23SAlexander Motin 	union ses_addl_data proto_data;	/* array sizes stored in header */
104f6ad3f23SAlexander Motin } ses_add_status_t;
105f6ad3f23SAlexander Motin 
106f6ad3f23SAlexander Motin typedef struct ses_element {
107f6ad3f23SAlexander Motin 	uint8_t eip;			/* eip bit is set */
108f6ad3f23SAlexander Motin 	uint16_t descr_len;		/* length of the descriptor */
109f6ad3f23SAlexander Motin 	char *descr;			/* descriptor for this object */
110f6ad3f23SAlexander Motin 	struct ses_addl_status addl;	/* additional status info */
111f6ad3f23SAlexander Motin } ses_element_t;
112f6ad3f23SAlexander Motin 
113f6ad3f23SAlexander Motin typedef struct ses_control_request {
114f6ad3f23SAlexander Motin 	int	      elm_idx;
115f6ad3f23SAlexander Motin 	ses_comstat_t elm_stat;
116f6ad3f23SAlexander Motin 	int	      result;
117f6ad3f23SAlexander Motin 	TAILQ_ENTRY(ses_control_request) links;
118f6ad3f23SAlexander Motin } ses_control_request_t;
119f6ad3f23SAlexander Motin TAILQ_HEAD(ses_control_reqlist, ses_control_request);
120f6ad3f23SAlexander Motin typedef struct ses_control_reqlist ses_control_reqlist_t;
121f6ad3f23SAlexander Motin enum {
122f6ad3f23SAlexander Motin 	SES_SETSTATUS_ENC_IDX = -1
123f6ad3f23SAlexander Motin };
124f6ad3f23SAlexander Motin 
125f6ad3f23SAlexander Motin static void
126f6ad3f23SAlexander Motin ses_terminate_control_requests(ses_control_reqlist_t *reqlist, int result)
127f6ad3f23SAlexander Motin {
128f6ad3f23SAlexander Motin 	ses_control_request_t *req;
129f6ad3f23SAlexander Motin 
130f6ad3f23SAlexander Motin 	while ((req = TAILQ_FIRST(reqlist)) != NULL) {
131f6ad3f23SAlexander Motin 		TAILQ_REMOVE(reqlist, req, links);
132f6ad3f23SAlexander Motin 		req->result = result;
133f6ad3f23SAlexander Motin 		wakeup(req);
134f6ad3f23SAlexander Motin 	}
135f6ad3f23SAlexander Motin }
136f6ad3f23SAlexander Motin 
137f6ad3f23SAlexander Motin enum ses_iter_index_values {
138f6ad3f23SAlexander Motin 	/**
139f6ad3f23SAlexander Motin 	 * \brief  Value of an initialized but invalid index
140f6ad3f23SAlexander Motin 	 *         in a ses_iterator object.
141f6ad3f23SAlexander Motin 	 *
142f6ad3f23SAlexander Motin 	 * This value is used for the  individual_element_index of
143f6ad3f23SAlexander Motin 	 * overal status elements and for all index types when
144f6ad3f23SAlexander Motin 	 * an iterator is first initialized.
145f6ad3f23SAlexander Motin 	 */
146f6ad3f23SAlexander Motin 	ITERATOR_INDEX_INVALID = -1,
147f6ad3f23SAlexander Motin 
148f6ad3f23SAlexander Motin 	/**
149f6ad3f23SAlexander Motin 	 * \brief  Value of an index in a ses_iterator object
150f6ad3f23SAlexander Motin 	 *	   when the iterator has traversed past the last
151f6ad3f23SAlexander Motin 	 *	   valid element..
152f6ad3f23SAlexander Motin 	 */
153f6ad3f23SAlexander Motin 	ITERATOR_INDEX_END     = INT_MAX
154f6ad3f23SAlexander Motin };
155f6ad3f23SAlexander Motin 
156f6ad3f23SAlexander Motin /**
157f6ad3f23SAlexander Motin  * \brief Structure encapsulating all data necessary to traverse the
158f6ad3f23SAlexander Motin  *        elements of a SES configuration.
159f6ad3f23SAlexander Motin  *
160f6ad3f23SAlexander Motin  * The ses_iterator object simplifies the task of iterating through all
161f6ad3f23SAlexander Motin  * elements detected via the SES configuration page by tracking the numerous
162f6ad3f23SAlexander Motin  * element indexes that, instead of memoizing in the softc, we calculate
163f6ad3f23SAlexander Motin  * on the fly during the traversal of the element objects.  The various
164f6ad3f23SAlexander Motin  * indexes are necessary due to the varying needs of matching objects in
165f6ad3f23SAlexander Motin  * the different SES pages.  Some pages (e.g. Status/Control) contain all
166f6ad3f23SAlexander Motin  * elements, while others (e.g. Additional Element Status) only contain
167f6ad3f23SAlexander Motin  * individual elements (no overal status elements) of particular types.
168f6ad3f23SAlexander Motin  *
169f6ad3f23SAlexander Motin  * To use an iterator, initialize it with ses_iter_init(), and then
170f6ad3f23SAlexander Motin  * use ses_iter_next() to traverse the elements (including the first) in
171f6ad3f23SAlexander Motin  * the configuration.  Once an iterator is initiailized with ses_iter_init(),
172f6ad3f23SAlexander Motin  * you may also seek to any particular element by either it's global or
173f6ad3f23SAlexander Motin  * individual element index via the ses_iter_seek_to() function.  You may
174f6ad3f23SAlexander Motin  * also return an iterator to the position just before the first element
175f6ad3f23SAlexander Motin  * (i.e. the same state as after an ses_iter_init()), with ses_iter_reset().
176f6ad3f23SAlexander Motin  */
177f6ad3f23SAlexander Motin struct ses_iterator {
178f6ad3f23SAlexander Motin 	/**
179f6ad3f23SAlexander Motin 	 * \brief Backlink to the overal software configuration structure.
180f6ad3f23SAlexander Motin 	 *
181f6ad3f23SAlexander Motin 	 * This is included for convenience so the iteration functions
182f6ad3f23SAlexander Motin 	 * need only take a single, struct ses_iterator *, argument.
183f6ad3f23SAlexander Motin 	 */
184f6ad3f23SAlexander Motin 	enc_softc_t *enc;
185f6ad3f23SAlexander Motin 
186f6ad3f23SAlexander Motin 	enc_cache_t *cache;
187f6ad3f23SAlexander Motin 
188f6ad3f23SAlexander Motin 	/**
189f6ad3f23SAlexander Motin 	 * \brief Index of the type of the current element within the
190f6ad3f23SAlexander Motin 	 *        ses_cache's ses_types array.
191f6ad3f23SAlexander Motin 	 */
192f6ad3f23SAlexander Motin 	int	          type_index;
193f6ad3f23SAlexander Motin 
194f6ad3f23SAlexander Motin 	/**
195f6ad3f23SAlexander Motin 	 * \brief The position (0 based) of this element relative to all other
196f6ad3f23SAlexander Motin 	 *        elements of this type.
197f6ad3f23SAlexander Motin 	 *
198f6ad3f23SAlexander Motin 	 * This index resets to zero every time the iterator transitions
199f6ad3f23SAlexander Motin 	 * to elements of a new type in the configuration.
200f6ad3f23SAlexander Motin 	 */
201f6ad3f23SAlexander Motin 	int	          type_element_index;
202f6ad3f23SAlexander Motin 
203f6ad3f23SAlexander Motin 	/**
204f6ad3f23SAlexander Motin 	 * \brief The position (0 based) of this element relative to all
205f6ad3f23SAlexander Motin 	 *        other individual status elements in the configuration.
206f6ad3f23SAlexander Motin 	 *
207f6ad3f23SAlexander Motin 	 * This index ranges from 0 through the number of individual
208f6ad3f23SAlexander Motin 	 * elements in the configuration.  When the iterator returns
209f6ad3f23SAlexander Motin 	 * an overall status element, individual_element_index is
210f6ad3f23SAlexander Motin 	 * set to ITERATOR_INDEX_INVALID, to indicate that it does
211f6ad3f23SAlexander Motin 	 * not apply to the current element.
212f6ad3f23SAlexander Motin 	 */
213f6ad3f23SAlexander Motin 	int	          individual_element_index;
214f6ad3f23SAlexander Motin 
215f6ad3f23SAlexander Motin 	/**
216f6ad3f23SAlexander Motin 	 * \brief The position (0 based) of this element relative to
217f6ad3f23SAlexander Motin 	 *        all elements in the configration.
218f6ad3f23SAlexander Motin 	 *
219f6ad3f23SAlexander Motin 	 * This index is appropriate for indexing into enc->ses_elm_map.
220f6ad3f23SAlexander Motin 	 */
221f6ad3f23SAlexander Motin 	int	          global_element_index;
222f6ad3f23SAlexander Motin 
223f6ad3f23SAlexander Motin 	/**
224f6ad3f23SAlexander Motin 	 * \brief The last valid individual element index of this
225f6ad3f23SAlexander Motin 	 *        iterator.
226f6ad3f23SAlexander Motin 	 *
227f6ad3f23SAlexander Motin 	 * When an iterator traverses an overal status element, the
228f6ad3f23SAlexander Motin 	 * individual element index is reset to ITERATOR_INDEX_INVALID
229f6ad3f23SAlexander Motin 	 * to prevent unintential use of the individual_element_index
230f6ad3f23SAlexander Motin 	 * field.  The saved_individual_element_index allows the iterator
231f6ad3f23SAlexander Motin 	 * to restore it's position in the individual elements upon
232f6ad3f23SAlexander Motin 	 * reaching the next individual element.
233f6ad3f23SAlexander Motin 	 */
234f6ad3f23SAlexander Motin 	int	          saved_individual_element_index;
235f6ad3f23SAlexander Motin };
236f6ad3f23SAlexander Motin 
237f6ad3f23SAlexander Motin typedef enum {
238f6ad3f23SAlexander Motin 	SES_UPDATE_NONE,
239f6ad3f23SAlexander Motin 	SES_UPDATE_PAGES,
240f6ad3f23SAlexander Motin 	SES_UPDATE_GETCONFIG,
241f6ad3f23SAlexander Motin 	SES_UPDATE_GETSTATUS,
242f6ad3f23SAlexander Motin 	SES_UPDATE_GETELMDESCS,
243f6ad3f23SAlexander Motin 	SES_UPDATE_GETELMADDLSTATUS,
244f6ad3f23SAlexander Motin 	SES_PROCESS_CONTROL_REQS,
245f6ad3f23SAlexander Motin 	SES_PUBLISH_PHYSPATHS,
246f6ad3f23SAlexander Motin 	SES_PUBLISH_CACHE,
247f6ad3f23SAlexander Motin 	SES_NUM_UPDATE_STATES
248f6ad3f23SAlexander Motin } ses_update_action;
249f6ad3f23SAlexander Motin 
250f6ad3f23SAlexander Motin static enc_softc_cleanup_t ses_softc_cleanup;
251f6ad3f23SAlexander Motin 
252f6ad3f23SAlexander Motin #define	SCSZ	0x8000
253f6ad3f23SAlexander Motin 
254f6ad3f23SAlexander Motin static fsm_fill_handler_t ses_fill_rcv_diag_io;
255f6ad3f23SAlexander Motin static fsm_fill_handler_t ses_fill_control_request;
256f6ad3f23SAlexander Motin static fsm_done_handler_t ses_process_pages;
257f6ad3f23SAlexander Motin static fsm_done_handler_t ses_process_config;
258f6ad3f23SAlexander Motin static fsm_done_handler_t ses_process_status;
259f6ad3f23SAlexander Motin static fsm_done_handler_t ses_process_elm_descs;
260f6ad3f23SAlexander Motin static fsm_done_handler_t ses_process_elm_addlstatus;
261f6ad3f23SAlexander Motin static fsm_done_handler_t ses_process_control_request;
262f6ad3f23SAlexander Motin static fsm_done_handler_t ses_publish_physpaths;
263f6ad3f23SAlexander Motin static fsm_done_handler_t ses_publish_cache;
264f6ad3f23SAlexander Motin 
265f6ad3f23SAlexander Motin static struct enc_fsm_state enc_fsm_states[SES_NUM_UPDATE_STATES] =
266f6ad3f23SAlexander Motin {
267f6ad3f23SAlexander Motin 	{ "SES_UPDATE_NONE", 0, 0, 0, NULL, NULL, NULL },
268f6ad3f23SAlexander Motin 	{
269f6ad3f23SAlexander Motin 		"SES_UPDATE_PAGES",
270f6ad3f23SAlexander Motin 		SesSupportedPages,
271f6ad3f23SAlexander Motin 		SCSZ,
272f6ad3f23SAlexander Motin 		60 * 1000,
273f6ad3f23SAlexander Motin 		ses_fill_rcv_diag_io,
274f6ad3f23SAlexander Motin 		ses_process_pages,
275f6ad3f23SAlexander Motin 		enc_error
276f6ad3f23SAlexander Motin 	},
277f6ad3f23SAlexander Motin 	{
278f6ad3f23SAlexander Motin 		"SES_UPDATE_GETCONFIG",
279f6ad3f23SAlexander Motin 		SesConfigPage,
280f6ad3f23SAlexander Motin 		SCSZ,
281f6ad3f23SAlexander Motin 		60 * 1000,
282f6ad3f23SAlexander Motin 		ses_fill_rcv_diag_io,
283f6ad3f23SAlexander Motin 		ses_process_config,
284f6ad3f23SAlexander Motin 		enc_error
285f6ad3f23SAlexander Motin 	},
286f6ad3f23SAlexander Motin 	{
287f6ad3f23SAlexander Motin 		"SES_UPDATE_GETSTATUS",
288f6ad3f23SAlexander Motin 		SesStatusPage,
289f6ad3f23SAlexander Motin 		SCSZ,
290f6ad3f23SAlexander Motin 		60 * 1000,
291f6ad3f23SAlexander Motin 		ses_fill_rcv_diag_io,
292f6ad3f23SAlexander Motin 		ses_process_status,
293f6ad3f23SAlexander Motin 		enc_error
294f6ad3f23SAlexander Motin 	},
295f6ad3f23SAlexander Motin 	{
296f6ad3f23SAlexander Motin 		"SES_UPDATE_GETELMDESCS",
297f6ad3f23SAlexander Motin 		SesElementDescriptor,
298f6ad3f23SAlexander Motin 		SCSZ,
299f6ad3f23SAlexander Motin 		60 * 1000,
300f6ad3f23SAlexander Motin 		ses_fill_rcv_diag_io,
301f6ad3f23SAlexander Motin 		ses_process_elm_descs,
302f6ad3f23SAlexander Motin 		enc_error
303f6ad3f23SAlexander Motin 	},
304f6ad3f23SAlexander Motin 	{
305f6ad3f23SAlexander Motin 		"SES_UPDATE_GETELMADDLSTATUS",
306f6ad3f23SAlexander Motin 		SesAddlElementStatus,
307f6ad3f23SAlexander Motin 		SCSZ,
308f6ad3f23SAlexander Motin 		60 * 1000,
309f6ad3f23SAlexander Motin 		ses_fill_rcv_diag_io,
310f6ad3f23SAlexander Motin 		ses_process_elm_addlstatus,
311f6ad3f23SAlexander Motin 		enc_error
312f6ad3f23SAlexander Motin 	},
313f6ad3f23SAlexander Motin 	{
314f6ad3f23SAlexander Motin 		"SES_PROCESS_CONTROL_REQS",
315f6ad3f23SAlexander Motin 		SesControlPage,
316f6ad3f23SAlexander Motin 		SCSZ,
317f6ad3f23SAlexander Motin 		60 * 1000,
318f6ad3f23SAlexander Motin 		ses_fill_control_request,
319f6ad3f23SAlexander Motin 		ses_process_control_request,
320f6ad3f23SAlexander Motin 		enc_error
321f6ad3f23SAlexander Motin 	},
322f6ad3f23SAlexander Motin 	{
323f6ad3f23SAlexander Motin 		"SES_PUBLISH_PHYSPATHS",
324f6ad3f23SAlexander Motin 		0,
325f6ad3f23SAlexander Motin 		0,
326f6ad3f23SAlexander Motin 		0,
327f6ad3f23SAlexander Motin 		NULL,
328f6ad3f23SAlexander Motin 		ses_publish_physpaths,
329f6ad3f23SAlexander Motin 		NULL
330f6ad3f23SAlexander Motin 	},
331f6ad3f23SAlexander Motin 	{
332f6ad3f23SAlexander Motin 		"SES_PUBLISH_CACHE",
333f6ad3f23SAlexander Motin 		0,
334f6ad3f23SAlexander Motin 		0,
335f6ad3f23SAlexander Motin 		0,
336f6ad3f23SAlexander Motin 		NULL,
337f6ad3f23SAlexander Motin 		ses_publish_cache,
338f6ad3f23SAlexander Motin 		NULL
339f6ad3f23SAlexander Motin 	}
340f6ad3f23SAlexander Motin };
341f6ad3f23SAlexander Motin 
342f6ad3f23SAlexander Motin typedef struct ses_cache {
343f6ad3f23SAlexander Motin 	/* Source for all the configuration data pointers */
344f6ad3f23SAlexander Motin 	const struct ses_cfg_page		*cfg_page;
345f6ad3f23SAlexander Motin 
346f6ad3f23SAlexander Motin 	/* References into the config page. */
347f6ad3f23SAlexander Motin 	const struct ses_enc_desc * const	*subencs;
348f6ad3f23SAlexander Motin 	uint8_t					 ses_ntypes;
349f6ad3f23SAlexander Motin 	const ses_type_t			*ses_types;
350f6ad3f23SAlexander Motin 
351f6ad3f23SAlexander Motin 	/* Source for all the status pointers */
352f6ad3f23SAlexander Motin 	const struct ses_status_page		*status_page;
353f6ad3f23SAlexander Motin 
354f6ad3f23SAlexander Motin 	/* Source for all the object descriptor pointers */
355f6ad3f23SAlexander Motin 	const struct ses_elem_descr_page	*elm_descs_page;
356f6ad3f23SAlexander Motin 
357f6ad3f23SAlexander Motin 	/* Source for all the additional object status pointers */
358f6ad3f23SAlexander Motin 	const struct ses_addl_elem_status_page  *elm_addlstatus_page;
359f6ad3f23SAlexander Motin 
360f6ad3f23SAlexander Motin } ses_cache_t;
361f6ad3f23SAlexander Motin 
362f6ad3f23SAlexander Motin typedef struct ses_softc {
363f6ad3f23SAlexander Motin 	uint32_t		ses_flags;
364f6ad3f23SAlexander Motin #define	SES_FLAG_TIMEDCOMP	0x01
365f6ad3f23SAlexander Motin #define	SES_FLAG_ADDLSTATUS	0x02
366f6ad3f23SAlexander Motin 
367f6ad3f23SAlexander Motin 	ses_control_reqlist_t	ses_requests;
368f6ad3f23SAlexander Motin 	ses_control_reqlist_t	ses_pending_requests;
369f6ad3f23SAlexander Motin } ses_softc_t;
370f6ad3f23SAlexander Motin 
371f6ad3f23SAlexander Motin /**
372f6ad3f23SAlexander Motin  * \brief Reset a SES iterator to just before the first element
373f6ad3f23SAlexander Motin  *        in the configuration.
374f6ad3f23SAlexander Motin  *
375f6ad3f23SAlexander Motin  * \param iter  The iterator object to reset.
376f6ad3f23SAlexander Motin  *
377f6ad3f23SAlexander Motin  * The indexes within a reset iterator are invalid and will only
378f6ad3f23SAlexander Motin  * become valid upon completion of a ses_iter_seek_to() or a
379f6ad3f23SAlexander Motin  * ses_iter_next().
380f6ad3f23SAlexander Motin  */
381f6ad3f23SAlexander Motin static void
382f6ad3f23SAlexander Motin ses_iter_reset(struct ses_iterator *iter)
383f6ad3f23SAlexander Motin {
384f6ad3f23SAlexander Motin 	/*
385f6ad3f23SAlexander Motin 	 * Set our indexes to just before the first valid element
386f6ad3f23SAlexander Motin 	 * of the first type (ITERATOR_INDEX_INVALID == -1).  This
387f6ad3f23SAlexander Motin 	 * simplifies the implementation of ses_iter_next().
388f6ad3f23SAlexander Motin 	 */
389f6ad3f23SAlexander Motin 	iter->type_index                     = 0;
390f6ad3f23SAlexander Motin 	iter->type_element_index             = ITERATOR_INDEX_INVALID;
391f6ad3f23SAlexander Motin 	iter->global_element_index           = ITERATOR_INDEX_INVALID;
392f6ad3f23SAlexander Motin 	iter->individual_element_index       = ITERATOR_INDEX_INVALID;
393f6ad3f23SAlexander Motin 	iter->saved_individual_element_index = ITERATOR_INDEX_INVALID;
394f6ad3f23SAlexander Motin }
395f6ad3f23SAlexander Motin 
396f6ad3f23SAlexander Motin /**
397f6ad3f23SAlexander Motin  * \brief Initialize the storage of a SES iterator and reset it to
398f6ad3f23SAlexander Motin  *        the position just before the first element of the
399f6ad3f23SAlexander Motin  *        configuration.
400f6ad3f23SAlexander Motin  *
401f6ad3f23SAlexander Motin  * \param enc	The SES softc for the SES instance whose configuration
402f6ad3f23SAlexander Motin  *              will be enumerated by this iterator.
403f6ad3f23SAlexander Motin  * \param iter  The iterator object to initialize.
404f6ad3f23SAlexander Motin  */
405f6ad3f23SAlexander Motin static void
406f6ad3f23SAlexander Motin ses_iter_init(enc_softc_t *enc, enc_cache_t *cache, struct ses_iterator *iter)
407f6ad3f23SAlexander Motin {
408f6ad3f23SAlexander Motin 	iter->enc = enc;
409f6ad3f23SAlexander Motin 	iter->cache = cache;
410f6ad3f23SAlexander Motin 	ses_iter_reset(iter);
411f6ad3f23SAlexander Motin }
412f6ad3f23SAlexander Motin 
413f6ad3f23SAlexander Motin /**
414f6ad3f23SAlexander Motin  * \brief Traverse the provided SES iterator to the next element
415f6ad3f23SAlexander Motin  *        within the configuraiton.
416f6ad3f23SAlexander Motin  *
417f6ad3f23SAlexander Motin  * \param iter  The iterator to move.
418f6ad3f23SAlexander Motin  *
419f6ad3f23SAlexander Motin  * \return  If a valid next element exists, a pointer to it's enc_element_t.
420f6ad3f23SAlexander Motin  *          Otherwise NULL.
421f6ad3f23SAlexander Motin  */
422f6ad3f23SAlexander Motin static enc_element_t *
423f6ad3f23SAlexander Motin ses_iter_next(struct ses_iterator *iter)
424f6ad3f23SAlexander Motin {
425f6ad3f23SAlexander Motin 	ses_cache_t	 *ses_cache;
426f6ad3f23SAlexander Motin 	const ses_type_t *element_type;
427f6ad3f23SAlexander Motin 
428f6ad3f23SAlexander Motin 	ses_cache = iter->cache->private;
429f6ad3f23SAlexander Motin 
430f6ad3f23SAlexander Motin 	/*
431f6ad3f23SAlexander Motin 	 * Note: Treat nelms as signed, so we will hit this case
432f6ad3f23SAlexander Motin 	 *       and immediately terminate the iteration if the
433f6ad3f23SAlexander Motin 	 *	 configuration has 0 objects.
434f6ad3f23SAlexander Motin 	 */
435f6ad3f23SAlexander Motin 	if (iter->global_element_index >= (int)iter->cache->nelms - 1) {
436f6ad3f23SAlexander Motin 
437f6ad3f23SAlexander Motin 		/* Elements exhausted. */
438f6ad3f23SAlexander Motin 		iter->type_index	       = ITERATOR_INDEX_END;
439f6ad3f23SAlexander Motin 		iter->type_element_index       = ITERATOR_INDEX_END;
440f6ad3f23SAlexander Motin 		iter->global_element_index     = ITERATOR_INDEX_END;
441f6ad3f23SAlexander Motin 		iter->individual_element_index = ITERATOR_INDEX_END;
442f6ad3f23SAlexander Motin 		return (NULL);
443f6ad3f23SAlexander Motin 	}
444f6ad3f23SAlexander Motin 
445f6ad3f23SAlexander Motin 	KASSERT((iter->type_index < ses_cache->ses_ntypes),
446f6ad3f23SAlexander Motin 		("Corrupted element iterator. %d not less than %d",
447f6ad3f23SAlexander Motin 		 iter->type_index, ses_cache->ses_ntypes));
448f6ad3f23SAlexander Motin 
449f6ad3f23SAlexander Motin 	element_type = &ses_cache->ses_types[iter->type_index];
450f6ad3f23SAlexander Motin 	iter->global_element_index++;
451f6ad3f23SAlexander Motin 	iter->type_element_index++;
452f6ad3f23SAlexander Motin 
453f6ad3f23SAlexander Motin 	/*
454f6ad3f23SAlexander Motin 	 * There is an object for overal type status in addition
455f6ad3f23SAlexander Motin 	 * to one for each allowed element, but only if the element
456f6ad3f23SAlexander Motin 	 * count is non-zero.
457f6ad3f23SAlexander Motin 	 */
458f6ad3f23SAlexander Motin 	if (iter->type_element_index > element_type->hdr->etype_maxelt) {
459f6ad3f23SAlexander Motin 
460f6ad3f23SAlexander Motin 		/*
461f6ad3f23SAlexander Motin 		 * We've exhausted the elements of this type.
462f6ad3f23SAlexander Motin 		 * This next element belongs to the next type.
463f6ad3f23SAlexander Motin 		 */
464f6ad3f23SAlexander Motin 		iter->type_index++;
465f6ad3f23SAlexander Motin 		iter->type_element_index = 0;
466f6ad3f23SAlexander Motin 		iter->saved_individual_element_index
467f6ad3f23SAlexander Motin 		    = iter->individual_element_index;
468f6ad3f23SAlexander Motin 		iter->individual_element_index = ITERATOR_INDEX_INVALID;
469f6ad3f23SAlexander Motin 	}
470f6ad3f23SAlexander Motin 
471f6ad3f23SAlexander Motin 	if (iter->type_element_index > 0) {
472f6ad3f23SAlexander Motin 		if (iter->type_element_index == 1) {
473f6ad3f23SAlexander Motin 			iter->individual_element_index
474f6ad3f23SAlexander Motin 			    = iter->saved_individual_element_index;
475f6ad3f23SAlexander Motin 		}
476f6ad3f23SAlexander Motin 		iter->individual_element_index++;
477f6ad3f23SAlexander Motin 	}
478f6ad3f23SAlexander Motin 
479f6ad3f23SAlexander Motin 	return (&iter->cache->elm_map[iter->global_element_index]);
480f6ad3f23SAlexander Motin }
481f6ad3f23SAlexander Motin 
482f6ad3f23SAlexander Motin /**
483f6ad3f23SAlexander Motin  * Element index types tracked by a SES iterator.
484f6ad3f23SAlexander Motin  */
485f6ad3f23SAlexander Motin typedef enum {
486f6ad3f23SAlexander Motin 	/**
487f6ad3f23SAlexander Motin 	 * Index relative to all elements (overall and individual)
488f6ad3f23SAlexander Motin 	 * in the system.
489f6ad3f23SAlexander Motin 	 */
490f6ad3f23SAlexander Motin 	SES_ELEM_INDEX_GLOBAL,
491f6ad3f23SAlexander Motin 
492f6ad3f23SAlexander Motin 	/**
493f6ad3f23SAlexander Motin 	 * \brief Index relative to all individual elements in the system.
494f6ad3f23SAlexander Motin 	 *
495f6ad3f23SAlexander Motin 	 * This index counts only individual elements, skipping overall
496f6ad3f23SAlexander Motin 	 * status elements.  This is the index space of the additional
497f6ad3f23SAlexander Motin 	 * element status page (page 0xa).
498f6ad3f23SAlexander Motin 	 */
499f6ad3f23SAlexander Motin 	SES_ELEM_INDEX_INDIVIDUAL
500f6ad3f23SAlexander Motin } ses_elem_index_type_t;
501f6ad3f23SAlexander Motin 
502f6ad3f23SAlexander Motin /**
503f6ad3f23SAlexander Motin  * \brief Move the provided iterator forwards or backwards to the object
504f6ad3f23SAlexander Motin  *        having the give index.
505f6ad3f23SAlexander Motin  *
506f6ad3f23SAlexander Motin  * \param iter           The iterator on which to perform the seek.
507f6ad3f23SAlexander Motin  * \param element_index  The index of the element to find.
508f6ad3f23SAlexander Motin  * \param index_type     The type (global or individual) of element_index.
509f6ad3f23SAlexander Motin  *
510f6ad3f23SAlexander Motin  * \return  If the element is found, a pointer to it's enc_element_t.
511f6ad3f23SAlexander Motin  *          Otherwise NULL.
512f6ad3f23SAlexander Motin  */
513f6ad3f23SAlexander Motin static enc_element_t *
514f6ad3f23SAlexander Motin ses_iter_seek_to(struct ses_iterator *iter, int element_index,
515f6ad3f23SAlexander Motin 		 ses_elem_index_type_t index_type)
516f6ad3f23SAlexander Motin {
517f6ad3f23SAlexander Motin 	enc_element_t	*element;
518f6ad3f23SAlexander Motin 	int		*cur_index;
519f6ad3f23SAlexander Motin 
520f6ad3f23SAlexander Motin 	if (index_type == SES_ELEM_INDEX_GLOBAL)
521f6ad3f23SAlexander Motin 		cur_index = &iter->global_element_index;
522f6ad3f23SAlexander Motin 	else
523f6ad3f23SAlexander Motin 		cur_index = &iter->individual_element_index;
524f6ad3f23SAlexander Motin 
525f6ad3f23SAlexander Motin 	if (*cur_index == element_index) {
526f6ad3f23SAlexander Motin 		/* Already there. */
527f6ad3f23SAlexander Motin 		return (&iter->cache->elm_map[iter->global_element_index]);
528f6ad3f23SAlexander Motin 	}
529f6ad3f23SAlexander Motin 
530f6ad3f23SAlexander Motin 	ses_iter_reset(iter);
531f6ad3f23SAlexander Motin 	while ((element = ses_iter_next(iter)) != NULL
532f6ad3f23SAlexander Motin 	    && *cur_index != element_index)
533f6ad3f23SAlexander Motin 		;
534f6ad3f23SAlexander Motin 
535f6ad3f23SAlexander Motin 	if (*cur_index != element_index)
536f6ad3f23SAlexander Motin 		return (NULL);
537f6ad3f23SAlexander Motin 
538f6ad3f23SAlexander Motin 	return (element);
539f6ad3f23SAlexander Motin }
540f6ad3f23SAlexander Motin 
541f6ad3f23SAlexander Motin #if 0
542f6ad3f23SAlexander Motin static int ses_encode(enc_softc_t *, uint8_t *, int, int,
543f6ad3f23SAlexander Motin     struct ses_comstat *);
544f6ad3f23SAlexander Motin #endif
545f6ad3f23SAlexander Motin static int ses_set_timed_completion(enc_softc_t *, uint8_t);
546f6ad3f23SAlexander Motin #if 0
547f6ad3f23SAlexander Motin static int ses_putstatus(enc_softc_t *, int, struct ses_comstat *);
548f6ad3f23SAlexander Motin #endif
549f6ad3f23SAlexander Motin 
550f6ad3f23SAlexander Motin static void ses_print_addl_data(enc_softc_t *, enc_element_t *);
551f6ad3f23SAlexander Motin 
552f6ad3f23SAlexander Motin /*=========================== SES cleanup routines ===========================*/
553f6ad3f23SAlexander Motin 
554f6ad3f23SAlexander Motin static void
555f6ad3f23SAlexander Motin ses_cache_free_elm_addlstatus(enc_softc_t *enc, enc_cache_t *cache)
556f6ad3f23SAlexander Motin {
557f6ad3f23SAlexander Motin 	ses_cache_t   *ses_cache;
558f6ad3f23SAlexander Motin 	ses_cache_t   *other_ses_cache;
559f6ad3f23SAlexander Motin 	enc_element_t *cur_elm;
560f6ad3f23SAlexander Motin 	enc_element_t *last_elm;
561f6ad3f23SAlexander Motin 
562f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "%s: enter\n", __func__);
563f6ad3f23SAlexander Motin 	ses_cache = cache->private;
564f6ad3f23SAlexander Motin 	if (ses_cache->elm_addlstatus_page == NULL)
565f6ad3f23SAlexander Motin 		return;
566f6ad3f23SAlexander Motin 
567f6ad3f23SAlexander Motin 	for (cur_elm = cache->elm_map,
568f6ad3f23SAlexander Motin 	     last_elm = &cache->elm_map[cache->nelms - 1];
569f6ad3f23SAlexander Motin 	     cur_elm <= last_elm; cur_elm++) {
570f6ad3f23SAlexander Motin 		ses_element_t *elmpriv;
571f6ad3f23SAlexander Motin 
572f6ad3f23SAlexander Motin 		elmpriv = cur_elm->elm_private;
573f6ad3f23SAlexander Motin 
574f6ad3f23SAlexander Motin 		/* Clear references to the additional status page. */
575f6ad3f23SAlexander Motin 		bzero(&elmpriv->addl, sizeof(elmpriv->addl));
576f6ad3f23SAlexander Motin 	}
577f6ad3f23SAlexander Motin 
578f6ad3f23SAlexander Motin 	other_ses_cache = enc_other_cache(enc, cache)->private;
579f6ad3f23SAlexander Motin 	if (other_ses_cache->elm_addlstatus_page
580f6ad3f23SAlexander Motin 	 != ses_cache->elm_addlstatus_page)
581f6ad3f23SAlexander Motin 		ENC_FREE(ses_cache->elm_addlstatus_page);
582f6ad3f23SAlexander Motin 	ses_cache->elm_addlstatus_page = NULL;
583f6ad3f23SAlexander Motin }
584f6ad3f23SAlexander Motin 
585f6ad3f23SAlexander Motin static void
586f6ad3f23SAlexander Motin ses_cache_free_elm_descs(enc_softc_t *enc, enc_cache_t *cache)
587f6ad3f23SAlexander Motin {
588f6ad3f23SAlexander Motin 	ses_cache_t   *ses_cache;
589f6ad3f23SAlexander Motin 	ses_cache_t   *other_ses_cache;
590f6ad3f23SAlexander Motin 	enc_element_t *cur_elm;
591f6ad3f23SAlexander Motin 	enc_element_t *last_elm;
592f6ad3f23SAlexander Motin 
593f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "%s: enter\n", __func__);
594f6ad3f23SAlexander Motin 	ses_cache = cache->private;
595f6ad3f23SAlexander Motin 	if (ses_cache->elm_descs_page == NULL)
596f6ad3f23SAlexander Motin 		return;
597f6ad3f23SAlexander Motin 
598f6ad3f23SAlexander Motin 	for (cur_elm = cache->elm_map,
599f6ad3f23SAlexander Motin 	     last_elm = &cache->elm_map[cache->nelms - 1];
600f6ad3f23SAlexander Motin 	     cur_elm <= last_elm; cur_elm++) {
601f6ad3f23SAlexander Motin 		ses_element_t *elmpriv;
602f6ad3f23SAlexander Motin 
603f6ad3f23SAlexander Motin 		elmpriv = cur_elm->elm_private;
604f6ad3f23SAlexander Motin 		elmpriv->descr_len = 0;
605f6ad3f23SAlexander Motin 		elmpriv->descr = NULL;
606f6ad3f23SAlexander Motin 	}
607f6ad3f23SAlexander Motin 
608f6ad3f23SAlexander Motin 	other_ses_cache = enc_other_cache(enc, cache)->private;
609f6ad3f23SAlexander Motin 	if (other_ses_cache->elm_descs_page
610f6ad3f23SAlexander Motin 	 != ses_cache->elm_descs_page)
611f6ad3f23SAlexander Motin 		ENC_FREE(ses_cache->elm_descs_page);
612f6ad3f23SAlexander Motin 	ses_cache->elm_descs_page = NULL;
613f6ad3f23SAlexander Motin }
614f6ad3f23SAlexander Motin 
615f6ad3f23SAlexander Motin static void
616f6ad3f23SAlexander Motin ses_cache_free_status(enc_softc_t *enc, enc_cache_t *cache)
617f6ad3f23SAlexander Motin {
618f6ad3f23SAlexander Motin 	ses_cache_t *ses_cache;
619f6ad3f23SAlexander Motin 	ses_cache_t *other_ses_cache;
620f6ad3f23SAlexander Motin 
621f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "%s: enter\n", __func__);
622f6ad3f23SAlexander Motin 	ses_cache   = cache->private;
623f6ad3f23SAlexander Motin 	if (ses_cache->status_page == NULL)
624f6ad3f23SAlexander Motin 		return;
625f6ad3f23SAlexander Motin 
626f6ad3f23SAlexander Motin 	other_ses_cache = enc_other_cache(enc, cache)->private;
627f6ad3f23SAlexander Motin 	if (other_ses_cache->status_page != ses_cache->status_page)
628f6ad3f23SAlexander Motin 		ENC_FREE(ses_cache->status_page);
629f6ad3f23SAlexander Motin 	ses_cache->status_page = NULL;
630f6ad3f23SAlexander Motin }
631f6ad3f23SAlexander Motin 
632f6ad3f23SAlexander Motin static void
633f6ad3f23SAlexander Motin ses_cache_free_elm_map(enc_softc_t *enc, enc_cache_t *cache)
634f6ad3f23SAlexander Motin {
635f6ad3f23SAlexander Motin 	enc_element_t *cur_elm;
636f6ad3f23SAlexander Motin 	enc_element_t *last_elm;
637f6ad3f23SAlexander Motin 
638f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "%s: enter\n", __func__);
639f6ad3f23SAlexander Motin 	if (cache->elm_map == NULL)
640f6ad3f23SAlexander Motin 		return;
641f6ad3f23SAlexander Motin 
642f6ad3f23SAlexander Motin 	ses_cache_free_elm_descs(enc, cache);
643f6ad3f23SAlexander Motin 	ses_cache_free_elm_addlstatus(enc, cache);
644f6ad3f23SAlexander Motin 	for (cur_elm = cache->elm_map,
645f6ad3f23SAlexander Motin 	     last_elm = &cache->elm_map[cache->nelms - 1];
646f6ad3f23SAlexander Motin 	     cur_elm <= last_elm; cur_elm++) {
647f6ad3f23SAlexander Motin 
648f6ad3f23SAlexander Motin 		ENC_FREE_AND_NULL(cur_elm->elm_private);
649f6ad3f23SAlexander Motin 	}
650f6ad3f23SAlexander Motin 	ENC_FREE_AND_NULL(cache->elm_map);
651f6ad3f23SAlexander Motin 	cache->nelms = 0;
652f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "%s: exit\n", __func__);
653f6ad3f23SAlexander Motin }
654f6ad3f23SAlexander Motin 
655f6ad3f23SAlexander Motin static void
656f6ad3f23SAlexander Motin ses_cache_free(enc_softc_t *enc, enc_cache_t *cache)
657f6ad3f23SAlexander Motin {
658f6ad3f23SAlexander Motin 	ses_cache_t *other_ses_cache;
659f6ad3f23SAlexander Motin 	ses_cache_t *ses_cache;
660f6ad3f23SAlexander Motin 
661f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "%s: enter\n", __func__);
662f6ad3f23SAlexander Motin 	ses_cache_free_elm_addlstatus(enc, cache);
663f6ad3f23SAlexander Motin 	ses_cache_free_status(enc, cache);
664f6ad3f23SAlexander Motin 	ses_cache_free_elm_map(enc, cache);
665f6ad3f23SAlexander Motin 
666f6ad3f23SAlexander Motin 	ses_cache = cache->private;
667f6ad3f23SAlexander Motin 	ses_cache->ses_ntypes = 0;
668f6ad3f23SAlexander Motin 
669f6ad3f23SAlexander Motin 	other_ses_cache = enc_other_cache(enc, cache)->private;
670f6ad3f23SAlexander Motin 	if (other_ses_cache->subencs != ses_cache->subencs)
671f6ad3f23SAlexander Motin 		ENC_FREE(ses_cache->subencs);
672f6ad3f23SAlexander Motin 	ses_cache->subencs = NULL;
673f6ad3f23SAlexander Motin 
674f6ad3f23SAlexander Motin 	if (other_ses_cache->ses_types != ses_cache->ses_types)
675f6ad3f23SAlexander Motin 		ENC_FREE(ses_cache->ses_types);
676f6ad3f23SAlexander Motin 	ses_cache->ses_types = NULL;
677f6ad3f23SAlexander Motin 
678f6ad3f23SAlexander Motin 	if (other_ses_cache->cfg_page != ses_cache->cfg_page)
679f6ad3f23SAlexander Motin 		ENC_FREE(ses_cache->cfg_page);
680f6ad3f23SAlexander Motin 	ses_cache->cfg_page = NULL;
681f6ad3f23SAlexander Motin 
682f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "%s: exit\n", __func__);
683f6ad3f23SAlexander Motin }
684f6ad3f23SAlexander Motin 
685f6ad3f23SAlexander Motin static void
686f6ad3f23SAlexander Motin ses_cache_clone(enc_softc_t *enc, enc_cache_t *src, enc_cache_t *dst)
687f6ad3f23SAlexander Motin {
688f6ad3f23SAlexander Motin 	ses_cache_t   *dst_ses_cache;
689f6ad3f23SAlexander Motin 	ses_cache_t   *src_ses_cache;
690f6ad3f23SAlexander Motin 	enc_element_t *src_elm;
691f6ad3f23SAlexander Motin 	enc_element_t *dst_elm;
692f6ad3f23SAlexander Motin 	enc_element_t *last_elm;
693f6ad3f23SAlexander Motin 
694f6ad3f23SAlexander Motin 	ses_cache_free(enc, dst);
695f6ad3f23SAlexander Motin 	src_ses_cache = src->private;
696f6ad3f23SAlexander Motin 	dst_ses_cache = dst->private;
697f6ad3f23SAlexander Motin 
698f6ad3f23SAlexander Motin 	/*
699f6ad3f23SAlexander Motin 	 * The cloned enclosure cache and ses specific cache are
700f6ad3f23SAlexander Motin 	 * mostly identical to the source.
701f6ad3f23SAlexander Motin 	 */
702f6ad3f23SAlexander Motin 	*dst = *src;
703f6ad3f23SAlexander Motin 	*dst_ses_cache = *src_ses_cache;
704f6ad3f23SAlexander Motin 
705f6ad3f23SAlexander Motin 	/*
706f6ad3f23SAlexander Motin 	 * But the ses cache storage is still independent.  Restore
707f6ad3f23SAlexander Motin 	 * the pointer that was clobbered by the structure copy above.
708f6ad3f23SAlexander Motin 	 */
709f6ad3f23SAlexander Motin 	dst->private = dst_ses_cache;
710f6ad3f23SAlexander Motin 
711f6ad3f23SAlexander Motin 	/*
712f6ad3f23SAlexander Motin 	 * The element map is independent even though it starts out
713f6ad3f23SAlexander Motin 	 * pointing to the same constant page data.
714f6ad3f23SAlexander Motin 	 */
715f6ad3f23SAlexander Motin 	dst->elm_map = ENC_MALLOCZ(dst->nelms * sizeof(enc_element_t));
716f6ad3f23SAlexander Motin 	memcpy(dst->elm_map, src->elm_map, dst->nelms * sizeof(enc_element_t));
717f6ad3f23SAlexander Motin 	for (dst_elm = dst->elm_map, src_elm = src->elm_map,
718f6ad3f23SAlexander Motin 	     last_elm = &src->elm_map[src->nelms - 1];
719f6ad3f23SAlexander Motin 	     src_elm <= last_elm; src_elm++, dst_elm++) {
720f6ad3f23SAlexander Motin 
721f6ad3f23SAlexander Motin 		dst_elm->elm_private = ENC_MALLOCZ(sizeof(ses_element_t));
722f6ad3f23SAlexander Motin 		memcpy(dst_elm->elm_private, src_elm->elm_private,
723f6ad3f23SAlexander Motin 		       sizeof(ses_element_t));
724f6ad3f23SAlexander Motin 	}
725f6ad3f23SAlexander Motin }
726f6ad3f23SAlexander Motin 
727f6ad3f23SAlexander Motin /* Structure accessors.  These are strongly typed to avoid errors. */
728f6ad3f23SAlexander Motin 
729f6ad3f23SAlexander Motin int
730f6ad3f23SAlexander Motin ses_elm_sas_descr_type(union ses_elm_sas_hdr *obj)
731f6ad3f23SAlexander Motin {
732f6ad3f23SAlexander Motin 	return ((obj)->base_hdr.byte1 >> 6);
733f6ad3f23SAlexander Motin }
734f6ad3f23SAlexander Motin int
735f6ad3f23SAlexander Motin ses_elm_addlstatus_proto(struct ses_elm_addlstatus_base_hdr *hdr)
736f6ad3f23SAlexander Motin {
737f6ad3f23SAlexander Motin 	return ((hdr)->byte0 & 0xf);
738f6ad3f23SAlexander Motin }
739f6ad3f23SAlexander Motin int
740f6ad3f23SAlexander Motin ses_elm_addlstatus_eip(struct ses_elm_addlstatus_base_hdr *hdr)
741f6ad3f23SAlexander Motin {
742f6ad3f23SAlexander Motin 	return ((hdr)->byte0 >> 4) & 0x1;
743f6ad3f23SAlexander Motin }
744f6ad3f23SAlexander Motin int
745f6ad3f23SAlexander Motin ses_elm_addlstatus_invalid(struct ses_elm_addlstatus_base_hdr *hdr)
746f6ad3f23SAlexander Motin {
747f6ad3f23SAlexander Motin 	return ((hdr)->byte0 >> 7);
748f6ad3f23SAlexander Motin }
749f6ad3f23SAlexander Motin int
750f6ad3f23SAlexander Motin ses_elm_sas_type0_not_all_phys(union ses_elm_sas_hdr *hdr)
751f6ad3f23SAlexander Motin {
752f6ad3f23SAlexander Motin 	return ((hdr)->type0_noneip.byte1 & 0x1);
753f6ad3f23SAlexander Motin }
754f6ad3f23SAlexander Motin int
755f6ad3f23SAlexander Motin ses_elm_sas_dev_phy_sata_dev(struct ses_elm_sas_device_phy *phy)
756f6ad3f23SAlexander Motin {
757f6ad3f23SAlexander Motin 	return ((phy)->target_ports & 0x1);
758f6ad3f23SAlexander Motin }
759f6ad3f23SAlexander Motin int
760f6ad3f23SAlexander Motin ses_elm_sas_dev_phy_sata_port(struct ses_elm_sas_device_phy *phy)
761f6ad3f23SAlexander Motin {
762f6ad3f23SAlexander Motin 	return ((phy)->target_ports >> 7);
763f6ad3f23SAlexander Motin }
764f6ad3f23SAlexander Motin int
765f6ad3f23SAlexander Motin ses_elm_sas_dev_phy_dev_type(struct ses_elm_sas_device_phy *phy)
766f6ad3f23SAlexander Motin {
767f6ad3f23SAlexander Motin 	return (((phy)->byte0 >> 4) & 0x7);
768f6ad3f23SAlexander Motin }
769f6ad3f23SAlexander Motin 
770f6ad3f23SAlexander Motin /**
771f6ad3f23SAlexander Motin  * \brief Verify that the cached configuration data in our softc
772f6ad3f23SAlexander Motin  *        is valid for processing the page data corresponding to
773f6ad3f23SAlexander Motin  *        the provided page header.
774f6ad3f23SAlexander Motin  *
775f6ad3f23SAlexander Motin  * \param ses_cache The SES cache to validate.
776f6ad3f23SAlexander Motin  * \param gen_code  The 4 byte generation code from a SES diagnostic
777f6ad3f23SAlexander Motin  *		    page header.
778f6ad3f23SAlexander Motin  *
779f6ad3f23SAlexander Motin  * \return  non-zero if true, 0 if false.
780f6ad3f23SAlexander Motin  */
781f6ad3f23SAlexander Motin static int
782f6ad3f23SAlexander Motin ses_config_cache_valid(ses_cache_t *ses_cache, const uint8_t *gen_code)
783f6ad3f23SAlexander Motin {
784f6ad3f23SAlexander Motin 	uint32_t cache_gc;
785f6ad3f23SAlexander Motin 	uint32_t cur_gc;
786f6ad3f23SAlexander Motin 
787f6ad3f23SAlexander Motin 	if (ses_cache->cfg_page == NULL)
788f6ad3f23SAlexander Motin 		return (0);
789f6ad3f23SAlexander Motin 
790f6ad3f23SAlexander Motin 	cache_gc = scsi_4btoul(ses_cache->cfg_page->hdr.gen_code);
791f6ad3f23SAlexander Motin 	cur_gc   = scsi_4btoul(gen_code);
792f6ad3f23SAlexander Motin 	return (cache_gc == cur_gc);
793f6ad3f23SAlexander Motin }
794f6ad3f23SAlexander Motin 
795f6ad3f23SAlexander Motin /**
796f6ad3f23SAlexander Motin  * Function signature for consumers of the ses_devids_iter() interface.
797f6ad3f23SAlexander Motin  */
798f6ad3f23SAlexander Motin typedef void ses_devid_callback_t(enc_softc_t *, enc_element_t *,
799f6ad3f23SAlexander Motin 				  struct scsi_vpd_id_descriptor *, void *);
800f6ad3f23SAlexander Motin 
801f6ad3f23SAlexander Motin /**
802f6ad3f23SAlexander Motin  * \brief Iterate over and create vpd device id records from the
803f6ad3f23SAlexander Motin  *        additional element status data for elm, passing that data
804f6ad3f23SAlexander Motin  *        to the provided callback.
805f6ad3f23SAlexander Motin  *
806f6ad3f23SAlexander Motin  * \param enc	        SES instance containing elm
807f6ad3f23SAlexander Motin  * \param elm	        Element for which to extract device ID data.
808f6ad3f23SAlexander Motin  * \param callback      The callback function to invoke on each generated
809f6ad3f23SAlexander Motin  *                      device id descriptor for elm.
810f6ad3f23SAlexander Motin  * \param callback_arg  Argument passed through to callback on each invocation.
811f6ad3f23SAlexander Motin  */
812f6ad3f23SAlexander Motin static void
813f6ad3f23SAlexander Motin ses_devids_iter(enc_softc_t *enc, enc_element_t *elm,
814f6ad3f23SAlexander Motin 		ses_devid_callback_t *callback, void *callback_arg)
815f6ad3f23SAlexander Motin {
816f6ad3f23SAlexander Motin 	ses_element_t           *elmpriv;
817f6ad3f23SAlexander Motin 	struct ses_addl_status *addl;
818f6ad3f23SAlexander Motin 	u_int                   i;
819f6ad3f23SAlexander Motin 	size_t			devid_record_size;
820f6ad3f23SAlexander Motin 
821f6ad3f23SAlexander Motin 	elmpriv = elm->elm_private;
822f6ad3f23SAlexander Motin 	addl = &(elmpriv->addl);
823f6ad3f23SAlexander Motin 
824f6ad3f23SAlexander Motin 	/*
825f6ad3f23SAlexander Motin 	 * Don't assume this object has additional status information, or
826f6ad3f23SAlexander Motin 	 * that it is a SAS device, or that it is a device slot device.
827f6ad3f23SAlexander Motin 	 */
828f6ad3f23SAlexander Motin 	if (addl->hdr == NULL || addl->proto_hdr.sas == NULL
829f6ad3f23SAlexander Motin 	 || addl->proto_data.sasdev_phys == NULL)
830f6ad3f23SAlexander Motin 		return;
831f6ad3f23SAlexander Motin 
832f6ad3f23SAlexander Motin 	devid_record_size = SVPD_DEVICE_ID_DESC_HDR_LEN
833f6ad3f23SAlexander Motin 			  + sizeof(struct scsi_vpd_id_naa_ieee_reg);
834f6ad3f23SAlexander Motin 	for (i = 0; i < addl->proto_hdr.sas->base_hdr.num_phys; i++) {
835f6ad3f23SAlexander Motin 		uint8_t			       devid_buf[devid_record_size];
836f6ad3f23SAlexander Motin 		struct scsi_vpd_id_descriptor *devid;
837f6ad3f23SAlexander Motin 		uint8_t			      *phy_addr;
838f6ad3f23SAlexander Motin 
839f6ad3f23SAlexander Motin 		devid = (struct scsi_vpd_id_descriptor *)devid_buf;
840f6ad3f23SAlexander Motin 		phy_addr = addl->proto_data.sasdev_phys[i].phy_addr;
841f6ad3f23SAlexander Motin 		devid->proto_codeset = (SCSI_PROTO_SAS << SVPD_ID_PROTO_SHIFT)
842f6ad3f23SAlexander Motin 				     | SVPD_ID_CODESET_BINARY;
843f6ad3f23SAlexander Motin 		devid->id_type       = SVPD_ID_PIV
844f6ad3f23SAlexander Motin 				     | SVPD_ID_ASSOC_PORT
845f6ad3f23SAlexander Motin 				     | SVPD_ID_TYPE_NAA;
846f6ad3f23SAlexander Motin 		devid->reserved	     = 0;
847f6ad3f23SAlexander Motin 		devid->length	     = sizeof(struct scsi_vpd_id_naa_ieee_reg);
848f6ad3f23SAlexander Motin 		memcpy(devid->identifier, phy_addr, devid->length);
849f6ad3f23SAlexander Motin 
850f6ad3f23SAlexander Motin 		callback(enc, elm, devid, callback_arg);
851f6ad3f23SAlexander Motin 	}
852f6ad3f23SAlexander Motin }
853f6ad3f23SAlexander Motin 
854f6ad3f23SAlexander Motin /**
855f6ad3f23SAlexander Motin  * Function signature for consumers of the ses_paths_iter() interface.
856f6ad3f23SAlexander Motin  */
857f6ad3f23SAlexander Motin typedef void ses_path_callback_t(enc_softc_t *, enc_element_t *,
858f6ad3f23SAlexander Motin 				 struct cam_path *, void *);
859f6ad3f23SAlexander Motin 
860f6ad3f23SAlexander Motin /**
861f6ad3f23SAlexander Motin  * Argument package passed through ses_devids_iter() by
862f6ad3f23SAlexander Motin  * ses_paths_iter() to ses_path_iter_devid_callback().
863f6ad3f23SAlexander Motin  */
864f6ad3f23SAlexander Motin typedef struct ses_path_iter_args {
865f6ad3f23SAlexander Motin 	ses_path_callback_t *callback;
866f6ad3f23SAlexander Motin 	void		    *callback_arg;
867f6ad3f23SAlexander Motin } ses_path_iter_args_t;
868f6ad3f23SAlexander Motin 
869f6ad3f23SAlexander Motin /**
870f6ad3f23SAlexander Motin  * ses_devids_iter() callback function used by ses_paths_iter()
871f6ad3f23SAlexander Motin  * to map device ids to peripheral driver instances.
872f6ad3f23SAlexander Motin  *
873f6ad3f23SAlexander Motin  * \param enc	  SES instance containing elm
874f6ad3f23SAlexander Motin  * \param elm	  Element on which device ID matching is active.
875f6ad3f23SAlexander Motin  * \param periph  A device ID corresponding to elm.
876f6ad3f23SAlexander Motin  * \param arg     Argument passed through to callback on each invocation.
877f6ad3f23SAlexander Motin  */
878f6ad3f23SAlexander Motin static void
879f6ad3f23SAlexander Motin ses_path_iter_devid_callback(enc_softc_t *enc, enc_element_t *elem,
880f6ad3f23SAlexander Motin 			       struct scsi_vpd_id_descriptor *devid,
881f6ad3f23SAlexander Motin 			       void *arg)
882f6ad3f23SAlexander Motin {
883f6ad3f23SAlexander Motin 	struct ccb_dev_match         cdm;
884f6ad3f23SAlexander Motin 	struct dev_match_pattern     match_pattern;
885f6ad3f23SAlexander Motin 	struct dev_match_result      match_result;
886f6ad3f23SAlexander Motin 	struct device_match_result  *device_match;
887f6ad3f23SAlexander Motin 	struct device_match_pattern *device_pattern;
888f6ad3f23SAlexander Motin 	ses_path_iter_args_t	    *args;
889*24a1ba91SAlexander Motin 	struct cam_sim		    *sim;
890f6ad3f23SAlexander Motin 
891f6ad3f23SAlexander Motin 	args = (ses_path_iter_args_t *)arg;
892f6ad3f23SAlexander Motin 	match_pattern.type = DEV_MATCH_DEVICE;
893f6ad3f23SAlexander Motin 	device_pattern = &match_pattern.pattern.device_pattern;
894f6ad3f23SAlexander Motin 	device_pattern->flags = DEV_MATCH_DEVID;
895f6ad3f23SAlexander Motin 	device_pattern->data.devid_pat.id_len =
896f6ad3f23SAlexander Motin 	    offsetof(struct scsi_vpd_id_descriptor, identifier)
897f6ad3f23SAlexander Motin 	  + devid->length;
898f6ad3f23SAlexander Motin 	memcpy(device_pattern->data.devid_pat.id, devid,
899f6ad3f23SAlexander Motin 	       device_pattern->data.devid_pat.id_len);
900f6ad3f23SAlexander Motin 
901f6ad3f23SAlexander Motin 	memset(&cdm, 0, sizeof(cdm));
902f6ad3f23SAlexander Motin 	if (xpt_create_path(&cdm.ccb_h.path, /*periph*/NULL, CAM_XPT_PATH_ID,
903f6ad3f23SAlexander Motin 			    CAM_TARGET_WILDCARD,
904f6ad3f23SAlexander Motin 			    CAM_LUN_WILDCARD) != CAM_REQ_CMP)
905f6ad3f23SAlexander Motin 		return;
906f6ad3f23SAlexander Motin 
907f6ad3f23SAlexander Motin 	cdm.ccb_h.func_code = XPT_DEV_MATCH;
908f6ad3f23SAlexander Motin 	cdm.num_patterns    = 1;
909f6ad3f23SAlexander Motin 	cdm.patterns        = &match_pattern;
910f6ad3f23SAlexander Motin 	cdm.pattern_buf_len = sizeof(match_pattern);
911f6ad3f23SAlexander Motin 	cdm.match_buf_len   = sizeof(match_result);
912f6ad3f23SAlexander Motin 	cdm.matches         = &match_result;
913f6ad3f23SAlexander Motin 
914f6ad3f23SAlexander Motin 	xpt_action((union ccb *)&cdm);
915f6ad3f23SAlexander Motin 	xpt_free_path(cdm.ccb_h.path);
916f6ad3f23SAlexander Motin 
917f6ad3f23SAlexander Motin 	if ((cdm.ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP
918f6ad3f23SAlexander Motin 	 || (cdm.status != CAM_DEV_MATCH_LAST
919f6ad3f23SAlexander Motin 	  && cdm.status != CAM_DEV_MATCH_MORE)
920f6ad3f23SAlexander Motin 	 || cdm.num_matches == 0)
921f6ad3f23SAlexander Motin 		return;
922f6ad3f23SAlexander Motin 
923f6ad3f23SAlexander Motin 	device_match = &match_result.result.device_result;
924*24a1ba91SAlexander Motin 	if (xpt_create_path_unlocked(&cdm.ccb_h.path, /*periph*/NULL,
925f6ad3f23SAlexander Motin 				     device_match->path_id,
926f6ad3f23SAlexander Motin 				     device_match->target_id,
927f6ad3f23SAlexander Motin 				     device_match->target_lun) != CAM_REQ_CMP)
928f6ad3f23SAlexander Motin 		return;
929f6ad3f23SAlexander Motin 
930f6ad3f23SAlexander Motin 	args->callback(enc, elem, cdm.ccb_h.path, args->callback_arg);
931*24a1ba91SAlexander Motin 
932*24a1ba91SAlexander Motin 	sim = xpt_path_sim(cdm.ccb_h.path);
933*24a1ba91SAlexander Motin 	CAM_SIM_LOCK(sim);
934f6ad3f23SAlexander Motin 	xpt_free_path(cdm.ccb_h.path);
935*24a1ba91SAlexander Motin 	CAM_SIM_UNLOCK(sim);
936f6ad3f23SAlexander Motin }
937f6ad3f23SAlexander Motin 
938f6ad3f23SAlexander Motin /**
939f6ad3f23SAlexander Motin  * \brief Iterate over and find the matching periph objects for the
940f6ad3f23SAlexander Motin  *        specified element.
941f6ad3f23SAlexander Motin  *
942f6ad3f23SAlexander Motin  * \param enc	        SES instance containing elm
943f6ad3f23SAlexander Motin  * \param elm	        Element for which to perform periph object matching.
944f6ad3f23SAlexander Motin  * \param callback      The callback function to invoke with each matching
945f6ad3f23SAlexander Motin  *                      periph object.
946f6ad3f23SAlexander Motin  * \param callback_arg  Argument passed through to callback on each invocation.
947f6ad3f23SAlexander Motin  */
948f6ad3f23SAlexander Motin static void
949f6ad3f23SAlexander Motin ses_paths_iter(enc_softc_t *enc, enc_element_t *elm,
950f6ad3f23SAlexander Motin 	       ses_path_callback_t *callback, void *callback_arg)
951f6ad3f23SAlexander Motin {
952f6ad3f23SAlexander Motin 	ses_path_iter_args_t args;
953f6ad3f23SAlexander Motin 
954f6ad3f23SAlexander Motin 	args.callback     = callback;
955f6ad3f23SAlexander Motin 	args.callback_arg = callback_arg;
956f6ad3f23SAlexander Motin 	ses_devids_iter(enc, elm, ses_path_iter_devid_callback, &args);
957f6ad3f23SAlexander Motin }
958f6ad3f23SAlexander Motin 
959f6ad3f23SAlexander Motin /**
960f6ad3f23SAlexander Motin  * ses_paths_iter() callback function used by ses_get_elmdevname()
961f6ad3f23SAlexander Motin  * to record periph driver instance strings corresponding to a SES
962f6ad3f23SAlexander Motin  * element.
963f6ad3f23SAlexander Motin  *
964f6ad3f23SAlexander Motin  * \param enc	  SES instance containing elm
965f6ad3f23SAlexander Motin  * \param elm	  Element on which periph matching is active.
966f6ad3f23SAlexander Motin  * \param periph  A periph instance that matches elm.
967f6ad3f23SAlexander Motin  * \param arg     Argument passed through to callback on each invocation.
968f6ad3f23SAlexander Motin  */
969f6ad3f23SAlexander Motin static void
970f6ad3f23SAlexander Motin ses_elmdevname_callback(enc_softc_t *enc, enc_element_t *elem,
971f6ad3f23SAlexander Motin 			struct cam_path *path, void *arg)
972f6ad3f23SAlexander Motin {
973f6ad3f23SAlexander Motin 	struct sbuf *sb;
974f6ad3f23SAlexander Motin 
975f6ad3f23SAlexander Motin 	sb = (struct sbuf *)arg;
976f6ad3f23SAlexander Motin 	cam_periph_list(path, sb);
977f6ad3f23SAlexander Motin }
978f6ad3f23SAlexander Motin 
979f6ad3f23SAlexander Motin /**
980f6ad3f23SAlexander Motin  * Argument package passed through ses_paths_iter() to
981f6ad3f23SAlexander Motin  * ses_getcampath_callback.
982f6ad3f23SAlexander Motin  */
983f6ad3f23SAlexander Motin typedef struct ses_setphyspath_callback_args {
984f6ad3f23SAlexander Motin 	struct sbuf *physpath;
985f6ad3f23SAlexander Motin 	int          num_set;
986f6ad3f23SAlexander Motin } ses_setphyspath_callback_args_t;
987f6ad3f23SAlexander Motin 
988f6ad3f23SAlexander Motin /**
989f6ad3f23SAlexander Motin  * \brief ses_paths_iter() callback to set the physical path on the
990f6ad3f23SAlexander Motin  *        CAM EDT entries corresponding to a given SES element.
991f6ad3f23SAlexander Motin  *
992f6ad3f23SAlexander Motin  * \param enc	  SES instance containing elm
993f6ad3f23SAlexander Motin  * \param elm	  Element on which periph matching is active.
994f6ad3f23SAlexander Motin  * \param periph  A periph instance that matches elm.
995f6ad3f23SAlexander Motin  * \param arg     Argument passed through to callback on each invocation.
996f6ad3f23SAlexander Motin  */
997f6ad3f23SAlexander Motin static void
998f6ad3f23SAlexander Motin ses_setphyspath_callback(enc_softc_t *enc, enc_element_t *elm,
999f6ad3f23SAlexander Motin 			 struct cam_path *path, void *arg)
1000f6ad3f23SAlexander Motin {
1001f6ad3f23SAlexander Motin 	struct ccb_dev_advinfo cdai;
1002f6ad3f23SAlexander Motin 	ses_setphyspath_callback_args_t *args;
1003f6ad3f23SAlexander Motin 	char *old_physpath;
1004f6ad3f23SAlexander Motin 
1005f6ad3f23SAlexander Motin 	args = (ses_setphyspath_callback_args_t *)arg;
1006f6ad3f23SAlexander Motin 	old_physpath = malloc(MAXPATHLEN, M_SCSIENC, M_WAITOK|M_ZERO);
1007*24a1ba91SAlexander Motin 	cam_periph_lock(enc->periph);
1008f6ad3f23SAlexander Motin 	xpt_setup_ccb(&cdai.ccb_h, path, CAM_PRIORITY_NORMAL);
1009f6ad3f23SAlexander Motin 	cdai.ccb_h.func_code = XPT_DEV_ADVINFO;
1010f6ad3f23SAlexander Motin 	cdai.buftype = CDAI_TYPE_PHYS_PATH;
1011f6ad3f23SAlexander Motin 	cdai.flags = 0;
1012f6ad3f23SAlexander Motin 	cdai.bufsiz = MAXPATHLEN;
1013f6ad3f23SAlexander Motin 	cdai.buf = old_physpath;
1014f6ad3f23SAlexander Motin 	xpt_action((union ccb *)&cdai);
1015f6ad3f23SAlexander Motin 	if ((cdai.ccb_h.status & CAM_DEV_QFRZN) != 0)
1016f6ad3f23SAlexander Motin 		cam_release_devq(cdai.ccb_h.path, 0, 0, 0, FALSE);
1017f6ad3f23SAlexander Motin 
1018f6ad3f23SAlexander Motin 	if (strcmp(old_physpath, sbuf_data(args->physpath)) != 0) {
1019f6ad3f23SAlexander Motin 
1020f6ad3f23SAlexander Motin 		xpt_setup_ccb(&cdai.ccb_h, path, CAM_PRIORITY_NORMAL);
1021f6ad3f23SAlexander Motin 		cdai.ccb_h.func_code = XPT_DEV_ADVINFO;
1022f6ad3f23SAlexander Motin 		cdai.buftype = CDAI_TYPE_PHYS_PATH;
1023f6ad3f23SAlexander Motin 		cdai.flags |= CDAI_FLAG_STORE;
1024f6ad3f23SAlexander Motin 		cdai.bufsiz = sbuf_len(args->physpath);
1025f6ad3f23SAlexander Motin 		cdai.buf = sbuf_data(args->physpath);
1026f6ad3f23SAlexander Motin 		xpt_action((union ccb *)&cdai);
1027f6ad3f23SAlexander Motin 		if ((cdai.ccb_h.status & CAM_DEV_QFRZN) != 0)
1028f6ad3f23SAlexander Motin 			cam_release_devq(cdai.ccb_h.path, 0, 0, 0, FALSE);
1029f6ad3f23SAlexander Motin 		if (cdai.ccb_h.status == CAM_REQ_CMP)
1030f6ad3f23SAlexander Motin 			args->num_set++;
1031f6ad3f23SAlexander Motin 	}
1032*24a1ba91SAlexander Motin 	cam_periph_unlock(enc->periph);
1033f6ad3f23SAlexander Motin 	free(old_physpath, M_SCSIENC);
1034f6ad3f23SAlexander Motin }
1035f6ad3f23SAlexander Motin 
1036f6ad3f23SAlexander Motin /**
1037f6ad3f23SAlexander Motin  * \brief Set a device's physical path string in CAM XPT.
1038f6ad3f23SAlexander Motin  *
1039f6ad3f23SAlexander Motin  * \param enc	SES instance containing elm
1040f6ad3f23SAlexander Motin  * \param elm	Element to publish physical path string for
1041f6ad3f23SAlexander Motin  * \param iter	Iterator whose state corresponds to elm
1042f6ad3f23SAlexander Motin  *
1043f6ad3f23SAlexander Motin  * \return	0 on success, errno otherwise.
1044f6ad3f23SAlexander Motin  */
1045f6ad3f23SAlexander Motin static int
1046f6ad3f23SAlexander Motin ses_set_physpath(enc_softc_t *enc, enc_element_t *elm,
1047f6ad3f23SAlexander Motin 		 struct ses_iterator *iter)
1048f6ad3f23SAlexander Motin {
1049f6ad3f23SAlexander Motin 	struct ccb_dev_advinfo cdai;
1050f6ad3f23SAlexander Motin 	ses_setphyspath_callback_args_t args;
1051f6ad3f23SAlexander Motin 	int ret;
1052f6ad3f23SAlexander Motin 	struct sbuf sb;
1053f6ad3f23SAlexander Motin 	uint8_t *devid, *elmaddr;
1054f6ad3f23SAlexander Motin 	ses_element_t *elmpriv;
1055f6ad3f23SAlexander Motin 
1056f6ad3f23SAlexander Motin 	ret = EIO;
1057f6ad3f23SAlexander Motin 	devid = NULL;
1058f6ad3f23SAlexander Motin 
1059f6ad3f23SAlexander Motin 	/*
1060f6ad3f23SAlexander Motin 	 * Assemble the components of the physical path starting with
1061f6ad3f23SAlexander Motin 	 * the device ID of the enclosure itself.
1062f6ad3f23SAlexander Motin 	 */
1063f6ad3f23SAlexander Motin 	xpt_setup_ccb(&cdai.ccb_h, enc->periph->path, CAM_PRIORITY_NORMAL);
1064f6ad3f23SAlexander Motin 	cdai.ccb_h.func_code = XPT_DEV_ADVINFO;
1065f6ad3f23SAlexander Motin 	cdai.buftype = CDAI_TYPE_SCSI_DEVID;
1066f6ad3f23SAlexander Motin 	cdai.bufsiz = CAM_SCSI_DEVID_MAXLEN;
1067f6ad3f23SAlexander Motin 	cdai.buf = devid = ENC_MALLOCZ(cdai.bufsiz);
1068f6ad3f23SAlexander Motin 	if (devid == NULL) {
1069f6ad3f23SAlexander Motin 		ret = ENOMEM;
1070f6ad3f23SAlexander Motin 		goto out;
1071f6ad3f23SAlexander Motin 	}
1072*24a1ba91SAlexander Motin 	cam_periph_lock(enc->periph);
1073f6ad3f23SAlexander Motin 	xpt_action((union ccb *)&cdai);
1074f6ad3f23SAlexander Motin 	if ((cdai.ccb_h.status & CAM_DEV_QFRZN) != 0)
1075f6ad3f23SAlexander Motin 		cam_release_devq(cdai.ccb_h.path, 0, 0, 0, FALSE);
1076*24a1ba91SAlexander Motin 	cam_periph_unlock(enc->periph);
1077f6ad3f23SAlexander Motin 	if (cdai.ccb_h.status != CAM_REQ_CMP)
1078f6ad3f23SAlexander Motin 		goto out;
1079f6ad3f23SAlexander Motin 
1080f6ad3f23SAlexander Motin 	elmaddr = scsi_get_devid((struct scsi_vpd_device_id *)cdai.buf,
1081f6ad3f23SAlexander Motin 	    cdai.provsiz, scsi_devid_is_naa_ieee_reg);
1082f6ad3f23SAlexander Motin 	if (elmaddr == NULL)
1083f6ad3f23SAlexander Motin 		goto out;
1084f6ad3f23SAlexander Motin 
1085f6ad3f23SAlexander Motin 	if (sbuf_new(&sb, NULL, 128, SBUF_AUTOEXTEND) == NULL) {
1086f6ad3f23SAlexander Motin 		ret = ENOMEM;
1087f6ad3f23SAlexander Motin 		goto out;
1088f6ad3f23SAlexander Motin 	}
1089f6ad3f23SAlexander Motin 	/* Next, generate the physical path string */
1090f6ad3f23SAlexander Motin 	sbuf_printf(&sb, "id1,enc@n%jx/type@%x/slot@%x",
1091f6ad3f23SAlexander Motin 	    scsi_8btou64(elmaddr), iter->type_index,
1092f6ad3f23SAlexander Motin 	    iter->type_element_index);
1093f6ad3f23SAlexander Motin 	/* Append the element descriptor if one exists */
1094f6ad3f23SAlexander Motin 	elmpriv = elm->elm_private;
1095f6ad3f23SAlexander Motin 	if (elmpriv->descr != NULL && elmpriv->descr_len > 0) {
1096f6ad3f23SAlexander Motin 		sbuf_cat(&sb, "/elmdesc@");
1097f6ad3f23SAlexander Motin 		sbuf_bcat(&sb, elmpriv->descr, elmpriv->descr_len);
1098f6ad3f23SAlexander Motin 	}
1099f6ad3f23SAlexander Motin 	sbuf_finish(&sb);
1100f6ad3f23SAlexander Motin 
1101f6ad3f23SAlexander Motin 	/*
1102f6ad3f23SAlexander Motin 	 * Set this physical path on any CAM devices with a device ID
1103f6ad3f23SAlexander Motin 	 * descriptor that matches one created from the SES additional
1104f6ad3f23SAlexander Motin 	 * status data for this element.
1105f6ad3f23SAlexander Motin 	 */
1106f6ad3f23SAlexander Motin 	args.physpath= &sb;
1107f6ad3f23SAlexander Motin 	args.num_set = 0;
1108f6ad3f23SAlexander Motin 	ses_paths_iter(enc, elm, ses_setphyspath_callback, &args);
1109f6ad3f23SAlexander Motin 	sbuf_delete(&sb);
1110f6ad3f23SAlexander Motin 
1111f6ad3f23SAlexander Motin 	ret = args.num_set == 0 ? ENOENT : 0;
1112f6ad3f23SAlexander Motin 
1113f6ad3f23SAlexander Motin out:
1114f6ad3f23SAlexander Motin 	if (devid != NULL)
1115f6ad3f23SAlexander Motin 		ENC_FREE(devid);
1116f6ad3f23SAlexander Motin 	return (ret);
1117f6ad3f23SAlexander Motin }
1118f6ad3f23SAlexander Motin 
1119f6ad3f23SAlexander Motin /**
1120f6ad3f23SAlexander Motin  * \brief Helper to set the CDB fields appropriately.
1121f6ad3f23SAlexander Motin  *
1122f6ad3f23SAlexander Motin  * \param cdb		Buffer containing the cdb.
1123f6ad3f23SAlexander Motin  * \param pagenum	SES diagnostic page to query for.
1124f6ad3f23SAlexander Motin  * \param dir		Direction of query.
1125f6ad3f23SAlexander Motin  */
1126f6ad3f23SAlexander Motin static void
1127f6ad3f23SAlexander Motin ses_page_cdb(char *cdb, int bufsiz, SesDiagPageCodes pagenum, int dir)
1128f6ad3f23SAlexander Motin {
1129f6ad3f23SAlexander Motin 
1130f6ad3f23SAlexander Motin 	/* Ref: SPC-4 r25 Section 6.20 Table 223 */
1131f6ad3f23SAlexander Motin 	if (dir == CAM_DIR_IN) {
1132f6ad3f23SAlexander Motin 		cdb[0] = RECEIVE_DIAGNOSTIC;
1133f6ad3f23SAlexander Motin 		cdb[1] = 1; /* Set page code valid bit */
1134f6ad3f23SAlexander Motin 		cdb[2] = pagenum;
1135f6ad3f23SAlexander Motin 	} else {
1136f6ad3f23SAlexander Motin 		cdb[0] = SEND_DIAGNOSTIC;
1137f6ad3f23SAlexander Motin 		cdb[1] = 0x10;
1138f6ad3f23SAlexander Motin 		cdb[2] = pagenum;
1139f6ad3f23SAlexander Motin 	}
1140f6ad3f23SAlexander Motin 	cdb[3] = bufsiz >> 8;	/* high bits */
1141f6ad3f23SAlexander Motin 	cdb[4] = bufsiz & 0xff;	/* low bits */
1142f6ad3f23SAlexander Motin 	cdb[5] = 0;
1143f6ad3f23SAlexander Motin }
1144f6ad3f23SAlexander Motin 
1145f6ad3f23SAlexander Motin /**
1146f6ad3f23SAlexander Motin  * \brief Discover whether this instance supports timed completion of a
1147f6ad3f23SAlexander Motin  * 	  RECEIVE DIAGNOSTIC RESULTS command requesting the Enclosure Status
1148f6ad3f23SAlexander Motin  * 	  page, and store the result in the softc, updating if necessary.
1149f6ad3f23SAlexander Motin  *
1150f6ad3f23SAlexander Motin  * \param enc	SES instance to query and update.
1151f6ad3f23SAlexander Motin  * \param tc_en	Value of timed completion to set (see \return).
1152f6ad3f23SAlexander Motin  *
1153f6ad3f23SAlexander Motin  * \return	1 if timed completion enabled, 0 otherwise.
1154f6ad3f23SAlexander Motin  */
1155f6ad3f23SAlexander Motin static int
1156f6ad3f23SAlexander Motin ses_set_timed_completion(enc_softc_t *enc, uint8_t tc_en)
1157f6ad3f23SAlexander Motin {
1158f6ad3f23SAlexander Motin 	int err;
1159f6ad3f23SAlexander Motin 	union ccb *ccb;
1160f6ad3f23SAlexander Motin 	struct cam_periph *periph;
1161f6ad3f23SAlexander Motin 	struct ses_mgmt_mode_page *mgmt;
1162f6ad3f23SAlexander Motin 	uint8_t *mode_buf;
1163f6ad3f23SAlexander Motin 	size_t mode_buf_len;
1164f6ad3f23SAlexander Motin 	ses_softc_t *ses;
1165f6ad3f23SAlexander Motin 
1166f6ad3f23SAlexander Motin 	periph = enc->periph;
1167f6ad3f23SAlexander Motin 	ses = enc->enc_private;
1168f6ad3f23SAlexander Motin 	ccb = cam_periph_getccb(periph, CAM_PRIORITY_NORMAL);
1169f6ad3f23SAlexander Motin 
1170f6ad3f23SAlexander Motin 	mode_buf_len = sizeof(struct ses_mgmt_mode_page);
1171f6ad3f23SAlexander Motin 	mode_buf = ENC_MALLOCZ(mode_buf_len);
1172f6ad3f23SAlexander Motin 	if (mode_buf == NULL)
1173f6ad3f23SAlexander Motin 		goto out;
1174f6ad3f23SAlexander Motin 
1175f6ad3f23SAlexander Motin 	scsi_mode_sense(&ccb->csio, /*retries*/4, enc_done, MSG_SIMPLE_Q_TAG,
1176f6ad3f23SAlexander Motin 	    /*dbd*/FALSE, SMS_PAGE_CTRL_CURRENT, SES_MGMT_MODE_PAGE_CODE,
1177f6ad3f23SAlexander Motin 	    mode_buf, mode_buf_len, SSD_FULL_SIZE, /*timeout*/60 * 1000);
1178f6ad3f23SAlexander Motin 
1179f6ad3f23SAlexander Motin 	/*
1180f6ad3f23SAlexander Motin 	 * Ignore illegal request errors, as they are quite common and we
1181f6ad3f23SAlexander Motin 	 * will print something out in that case anyway.
1182f6ad3f23SAlexander Motin 	 */
1183f6ad3f23SAlexander Motin 	err = cam_periph_runccb(ccb, enc_error, ENC_CFLAGS,
1184f6ad3f23SAlexander Motin 	    ENC_FLAGS|SF_QUIET_IR, NULL);
1185f6ad3f23SAlexander Motin 	if (ccb->ccb_h.status != CAM_REQ_CMP) {
11865e6609a2SMatt Jacob 		ENC_VLOG(enc, "Timed Completion Unsupported\n");
1187f6ad3f23SAlexander Motin 		goto release;
1188f6ad3f23SAlexander Motin 	}
1189f6ad3f23SAlexander Motin 
1190f6ad3f23SAlexander Motin 	/* Skip the mode select if the desired value is already set */
1191f6ad3f23SAlexander Motin 	mgmt = (struct ses_mgmt_mode_page *)mode_buf;
1192f6ad3f23SAlexander Motin 	if ((mgmt->byte5 & SES_MGMT_TIMED_COMP_EN) == tc_en)
1193f6ad3f23SAlexander Motin 		goto done;
1194f6ad3f23SAlexander Motin 
1195f6ad3f23SAlexander Motin 	/* Value is not what we wanted, set it */
1196f6ad3f23SAlexander Motin 	if (tc_en)
1197f6ad3f23SAlexander Motin 		mgmt->byte5 |= SES_MGMT_TIMED_COMP_EN;
1198f6ad3f23SAlexander Motin 	else
1199f6ad3f23SAlexander Motin 		mgmt->byte5 &= ~SES_MGMT_TIMED_COMP_EN;
1200f6ad3f23SAlexander Motin 	/* SES2r20: a completion time of zero means as long as possible */
1201f6ad3f23SAlexander Motin 	bzero(&mgmt->max_comp_time, sizeof(mgmt->max_comp_time));
1202f6ad3f23SAlexander Motin 
1203f6ad3f23SAlexander Motin 	scsi_mode_select(&ccb->csio, 5, enc_done, MSG_SIMPLE_Q_TAG,
1204f6ad3f23SAlexander Motin 	    /*page_fmt*/FALSE, /*save_pages*/TRUE, mode_buf, mode_buf_len,
1205f6ad3f23SAlexander Motin 	    SSD_FULL_SIZE, /*timeout*/60 * 1000);
1206f6ad3f23SAlexander Motin 
1207f6ad3f23SAlexander Motin 	err = cam_periph_runccb(ccb, enc_error, ENC_CFLAGS, ENC_FLAGS, NULL);
1208f6ad3f23SAlexander Motin 	if (ccb->ccb_h.status != CAM_REQ_CMP) {
12095e6609a2SMatt Jacob 		ENC_VLOG(enc, "Timed Completion Set Failed\n");
1210f6ad3f23SAlexander Motin 		goto release;
1211f6ad3f23SAlexander Motin 	}
1212f6ad3f23SAlexander Motin 
1213f6ad3f23SAlexander Motin done:
1214f6ad3f23SAlexander Motin 	if ((mgmt->byte5 & SES_MGMT_TIMED_COMP_EN) != 0) {
1215f6ad3f23SAlexander Motin 		ENC_LOG(enc, "Timed Completion Enabled\n");
1216f6ad3f23SAlexander Motin 		ses->ses_flags |= SES_FLAG_TIMEDCOMP;
1217f6ad3f23SAlexander Motin 	} else {
1218f6ad3f23SAlexander Motin 		ENC_LOG(enc, "Timed Completion Disabled\n");
1219f6ad3f23SAlexander Motin 		ses->ses_flags &= ~SES_FLAG_TIMEDCOMP;
1220f6ad3f23SAlexander Motin 	}
1221f6ad3f23SAlexander Motin release:
1222f6ad3f23SAlexander Motin 	ENC_FREE(mode_buf);
1223f6ad3f23SAlexander Motin 	xpt_release_ccb(ccb);
1224f6ad3f23SAlexander Motin out:
1225f6ad3f23SAlexander Motin 	return (ses->ses_flags & SES_FLAG_TIMEDCOMP);
1226f6ad3f23SAlexander Motin }
1227f6ad3f23SAlexander Motin 
1228f6ad3f23SAlexander Motin /**
1229f6ad3f23SAlexander Motin  * \brief Process the list of supported pages and update flags.
1230f6ad3f23SAlexander Motin  *
1231f6ad3f23SAlexander Motin  * \param enc       SES device to query.
1232f6ad3f23SAlexander Motin  * \param buf       Buffer containing the config page.
1233f6ad3f23SAlexander Motin  * \param xfer_len  Length of the config page in the buffer.
1234f6ad3f23SAlexander Motin  *
1235f6ad3f23SAlexander Motin  * \return  0 on success, errno otherwise.
1236f6ad3f23SAlexander Motin  */
1237f6ad3f23SAlexander Motin static int
1238f6ad3f23SAlexander Motin ses_process_pages(enc_softc_t *enc, struct enc_fsm_state *state,
1239f6ad3f23SAlexander Motin     union ccb *ccb, uint8_t **bufp, int error, int xfer_len)
1240f6ad3f23SAlexander Motin {
1241f6ad3f23SAlexander Motin 	ses_softc_t *ses;
1242f6ad3f23SAlexander Motin 	struct scsi_diag_page *page;
1243f6ad3f23SAlexander Motin 	int err, i, length;
1244f6ad3f23SAlexander Motin 
1245f6ad3f23SAlexander Motin 	CAM_DEBUG(enc->periph->path, CAM_DEBUG_SUBTRACE,
1246f6ad3f23SAlexander Motin 	    ("entering %s(%p, %d)\n", __func__, bufp, xfer_len));
1247f6ad3f23SAlexander Motin 	ses = enc->enc_private;
1248f6ad3f23SAlexander Motin 	err = -1;
1249f6ad3f23SAlexander Motin 
1250f6ad3f23SAlexander Motin 	if (error != 0) {
1251f6ad3f23SAlexander Motin 		err = error;
1252f6ad3f23SAlexander Motin 		goto out;
1253f6ad3f23SAlexander Motin 	}
1254f6ad3f23SAlexander Motin 	if (xfer_len < sizeof(*page)) {
12555e6609a2SMatt Jacob 		ENC_VLOG(enc, "Unable to parse Diag Pages List Header\n");
1256f6ad3f23SAlexander Motin 		err = EIO;
1257f6ad3f23SAlexander Motin 		goto out;
1258f6ad3f23SAlexander Motin 	}
1259f6ad3f23SAlexander Motin 	page = (struct scsi_diag_page *)*bufp;
1260f6ad3f23SAlexander Motin 	length = scsi_2btoul(page->length);
1261f6ad3f23SAlexander Motin 	if (length + offsetof(struct scsi_diag_page, params) > xfer_len) {
12625e6609a2SMatt Jacob 		ENC_VLOG(enc, "Diag Pages List Too Long\n");
1263f6ad3f23SAlexander Motin 		goto out;
1264f6ad3f23SAlexander Motin 	}
1265f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "%s: page length %d, xfer_len %d\n",
1266f6ad3f23SAlexander Motin 		 __func__, length, xfer_len);
1267f6ad3f23SAlexander Motin 
1268f6ad3f23SAlexander Motin 	err = 0;
1269f6ad3f23SAlexander Motin 	for (i = 0; i < length; i++) {
1270f6ad3f23SAlexander Motin 		if (page->params[i] == SesAddlElementStatus) {
1271f6ad3f23SAlexander Motin 			ses->ses_flags |= SES_FLAG_ADDLSTATUS;
1272f6ad3f23SAlexander Motin 			break;
1273f6ad3f23SAlexander Motin 		}
1274f6ad3f23SAlexander Motin 	}
1275f6ad3f23SAlexander Motin 
1276f6ad3f23SAlexander Motin out:
1277f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "%s: exiting with err %d\n", __func__, err);
1278f6ad3f23SAlexander Motin 	return (err);
1279f6ad3f23SAlexander Motin }
1280f6ad3f23SAlexander Motin 
1281f6ad3f23SAlexander Motin /**
1282f6ad3f23SAlexander Motin  * \brief Process the config page and update associated structures.
1283f6ad3f23SAlexander Motin  *
1284f6ad3f23SAlexander Motin  * \param enc       SES device to query.
1285f6ad3f23SAlexander Motin  * \param buf       Buffer containing the config page.
1286f6ad3f23SAlexander Motin  * \param xfer_len  Length of the config page in the buffer.
1287f6ad3f23SAlexander Motin  *
1288f6ad3f23SAlexander Motin  * \return  0 on success, errno otherwise.
1289f6ad3f23SAlexander Motin  */
1290f6ad3f23SAlexander Motin static int
1291f6ad3f23SAlexander Motin ses_process_config(enc_softc_t *enc, struct enc_fsm_state *state,
1292f6ad3f23SAlexander Motin     union ccb *ccb, uint8_t **bufp, int error, int xfer_len)
1293f6ad3f23SAlexander Motin {
1294f6ad3f23SAlexander Motin 	struct ses_iterator iter;
1295f6ad3f23SAlexander Motin 	ses_softc_t *ses;
1296f6ad3f23SAlexander Motin 	enc_cache_t *enc_cache;
1297f6ad3f23SAlexander Motin 	ses_cache_t *ses_cache;
1298f6ad3f23SAlexander Motin 	uint8_t *buf;
1299f6ad3f23SAlexander Motin 	int length;
1300f6ad3f23SAlexander Motin 	int err;
1301f6ad3f23SAlexander Motin 	int nelm;
1302f6ad3f23SAlexander Motin 	int ntype;
1303f6ad3f23SAlexander Motin 	struct ses_cfg_page *cfg_page;
1304f6ad3f23SAlexander Motin 	struct ses_enc_desc *buf_subenc;
1305f6ad3f23SAlexander Motin 	const struct ses_enc_desc **subencs;
1306f6ad3f23SAlexander Motin 	const struct ses_enc_desc **cur_subenc;
1307f6ad3f23SAlexander Motin 	const struct ses_enc_desc **last_subenc;
1308f6ad3f23SAlexander Motin 	ses_type_t *ses_types;
1309f6ad3f23SAlexander Motin 	ses_type_t *sestype;
1310f6ad3f23SAlexander Motin 	const struct ses_elm_type_desc *cur_buf_type;
1311f6ad3f23SAlexander Motin 	const struct ses_elm_type_desc *last_buf_type;
1312f6ad3f23SAlexander Motin 	uint8_t *last_valid_byte;
1313f6ad3f23SAlexander Motin 	enc_element_t *element;
1314f6ad3f23SAlexander Motin 	const char *type_text;
1315f6ad3f23SAlexander Motin 
1316f6ad3f23SAlexander Motin 	CAM_DEBUG(enc->periph->path, CAM_DEBUG_SUBTRACE,
1317f6ad3f23SAlexander Motin 	    ("entering %s(%p, %d)\n", __func__, bufp, xfer_len));
1318f6ad3f23SAlexander Motin 	ses = enc->enc_private;
1319f6ad3f23SAlexander Motin 	enc_cache = &enc->enc_daemon_cache;
1320f6ad3f23SAlexander Motin 	ses_cache = enc_cache->private;
1321f6ad3f23SAlexander Motin 	buf = *bufp;
1322f6ad3f23SAlexander Motin 	err = -1;;
1323f6ad3f23SAlexander Motin 
1324f6ad3f23SAlexander Motin 	if (error != 0) {
1325f6ad3f23SAlexander Motin 		err = error;
1326f6ad3f23SAlexander Motin 		goto out;
1327f6ad3f23SAlexander Motin 	}
1328f6ad3f23SAlexander Motin 	if (xfer_len < sizeof(cfg_page->hdr)) {
13295e6609a2SMatt Jacob 		ENC_VLOG(enc, "Unable to parse SES Config Header\n");
1330f6ad3f23SAlexander Motin 		err = EIO;
1331f6ad3f23SAlexander Motin 		goto out;
1332f6ad3f23SAlexander Motin 	}
1333f6ad3f23SAlexander Motin 
1334f6ad3f23SAlexander Motin 	cfg_page = (struct ses_cfg_page *)buf;
1335f6ad3f23SAlexander Motin 	length = ses_page_length(&cfg_page->hdr);
1336f6ad3f23SAlexander Motin 	if (length > xfer_len) {
13375e6609a2SMatt Jacob 		ENC_VLOG(enc, "Enclosure Config Page Too Long\n");
1338f6ad3f23SAlexander Motin 		goto out;
1339f6ad3f23SAlexander Motin 	}
1340f6ad3f23SAlexander Motin 	last_valid_byte = &buf[length - 1];
1341f6ad3f23SAlexander Motin 
1342f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "%s: total page length %d, xfer_len %d\n",
1343f6ad3f23SAlexander Motin 		 __func__, length, xfer_len);
1344f6ad3f23SAlexander Motin 
1345f6ad3f23SAlexander Motin 	err = 0;
1346f6ad3f23SAlexander Motin 	if (ses_config_cache_valid(ses_cache, cfg_page->hdr.gen_code)) {
1347f6ad3f23SAlexander Motin 
1348f6ad3f23SAlexander Motin 		/* Our cache is still valid.  Proceed to fetching status. */
1349f6ad3f23SAlexander Motin 		goto out;
1350f6ad3f23SAlexander Motin 	}
1351f6ad3f23SAlexander Motin 
1352f6ad3f23SAlexander Motin 	/* Cache is no longer valid.  Free old data to make way for new. */
1353f6ad3f23SAlexander Motin 	ses_cache_free(enc, enc_cache);
1354f6ad3f23SAlexander Motin 	ENC_VLOG(enc, "Generation Code 0x%x has %d SubEnclosures\n",
1355f6ad3f23SAlexander Motin 	    scsi_4btoul(cfg_page->hdr.gen_code),
1356f6ad3f23SAlexander Motin 	    ses_cfg_page_get_num_subenc(cfg_page));
1357f6ad3f23SAlexander Motin 
1358f6ad3f23SAlexander Motin 	/* Take ownership of the buffer. */
1359f6ad3f23SAlexander Motin 	ses_cache->cfg_page = cfg_page;
1360f6ad3f23SAlexander Motin 	*bufp = NULL;
1361f6ad3f23SAlexander Motin 
1362f6ad3f23SAlexander Motin 	/*
1363f6ad3f23SAlexander Motin 	 * Now waltz through all the subenclosures summing the number of
1364f6ad3f23SAlexander Motin 	 * types available in each.
1365f6ad3f23SAlexander Motin 	 */
1366f6ad3f23SAlexander Motin 	subencs = ENC_MALLOCZ(ses_cfg_page_get_num_subenc(cfg_page)
1367f6ad3f23SAlexander Motin 			    * sizeof(*subencs));
1368f6ad3f23SAlexander Motin 	if (subencs == NULL) {
1369f6ad3f23SAlexander Motin 		err = ENOMEM;
1370f6ad3f23SAlexander Motin 		goto out;
1371f6ad3f23SAlexander Motin 	}
1372f6ad3f23SAlexander Motin 	/*
1373f6ad3f23SAlexander Motin 	 * Sub-enclosure data is const after construction (i.e. when
1374f6ad3f23SAlexander Motin 	 * accessed via our cache object.
1375f6ad3f23SAlexander Motin 	 *
1376f6ad3f23SAlexander Motin 	 * The cast here is not required in C++ but C99 is not so
1377f6ad3f23SAlexander Motin 	 * sophisticated (see C99 6.5.16.1(1)).
1378f6ad3f23SAlexander Motin 	 */
1379f6ad3f23SAlexander Motin 	ses_cache->subencs = subencs;
1380f6ad3f23SAlexander Motin 
1381f6ad3f23SAlexander Motin 	buf_subenc = cfg_page->subencs;
1382f6ad3f23SAlexander Motin 	cur_subenc = subencs;
1383f6ad3f23SAlexander Motin 	last_subenc = &subencs[ses_cfg_page_get_num_subenc(cfg_page) - 1];
1384f6ad3f23SAlexander Motin 	ntype = 0;
1385f6ad3f23SAlexander Motin 	while (cur_subenc <= last_subenc) {
1386f6ad3f23SAlexander Motin 
1387f6ad3f23SAlexander Motin 		if (!ses_enc_desc_is_complete(buf_subenc, last_valid_byte)) {
13885e6609a2SMatt Jacob 			ENC_VLOG(enc, "Enclosure %d Beyond End of "
1389f6ad3f23SAlexander Motin 			    "Descriptors\n", cur_subenc - subencs);
1390f6ad3f23SAlexander Motin 			err = EIO;
1391f6ad3f23SAlexander Motin 			goto out;
1392f6ad3f23SAlexander Motin 		}
1393f6ad3f23SAlexander Motin 
1394f6ad3f23SAlexander Motin 		ENC_VLOG(enc, " SubEnclosure ID %d, %d Types With this ID, "
1395f6ad3f23SAlexander Motin 		    "Descriptor Length %d, offset %d\n", buf_subenc->subenc_id,
1396f6ad3f23SAlexander Motin 		    buf_subenc->num_types, buf_subenc->length,
1397f6ad3f23SAlexander Motin 		    &buf_subenc->byte0 - buf);
1398f6ad3f23SAlexander Motin 		ENC_VLOG(enc, "WWN: %jx\n",
1399f6ad3f23SAlexander Motin 		    (uintmax_t)scsi_8btou64(buf_subenc->logical_id));
1400f6ad3f23SAlexander Motin 
1401f6ad3f23SAlexander Motin 		ntype += buf_subenc->num_types;
1402f6ad3f23SAlexander Motin 		*cur_subenc = buf_subenc;
1403f6ad3f23SAlexander Motin 		cur_subenc++;
1404f6ad3f23SAlexander Motin 		buf_subenc = ses_enc_desc_next(buf_subenc);
1405f6ad3f23SAlexander Motin 	}
1406f6ad3f23SAlexander Motin 
1407f6ad3f23SAlexander Motin 	/* Process the type headers. */
1408f6ad3f23SAlexander Motin 	ses_types = ENC_MALLOCZ(ntype * sizeof(*ses_types));
1409f6ad3f23SAlexander Motin 	if (ses_types == NULL) {
1410f6ad3f23SAlexander Motin 		err = ENOMEM;
1411f6ad3f23SAlexander Motin 		goto out;
1412f6ad3f23SAlexander Motin 	}
1413f6ad3f23SAlexander Motin 	/*
1414f6ad3f23SAlexander Motin 	 * Type data is const after construction (i.e. when accessed via
1415f6ad3f23SAlexander Motin 	 * our cache object.
1416f6ad3f23SAlexander Motin 	 */
1417f6ad3f23SAlexander Motin 	ses_cache->ses_types = ses_types;
1418f6ad3f23SAlexander Motin 
1419f6ad3f23SAlexander Motin 	cur_buf_type = (const struct ses_elm_type_desc *)
1420f6ad3f23SAlexander Motin 	    (&(*last_subenc)->length + (*last_subenc)->length + 1);
1421f6ad3f23SAlexander Motin 	last_buf_type = cur_buf_type + ntype - 1;
1422f6ad3f23SAlexander Motin 	type_text = (const uint8_t *)(last_buf_type + 1);
1423f6ad3f23SAlexander Motin 	nelm = 0;
1424f6ad3f23SAlexander Motin 	sestype = ses_types;
1425f6ad3f23SAlexander Motin 	while (cur_buf_type <= last_buf_type) {
1426f6ad3f23SAlexander Motin 		if (&cur_buf_type->etype_txt_len > last_valid_byte) {
14275e6609a2SMatt Jacob 			ENC_VLOG(enc, "Runt Enclosure Type Header %d\n",
1428f6ad3f23SAlexander Motin 			    sestype - ses_types);
1429f6ad3f23SAlexander Motin 			err = EIO;
1430f6ad3f23SAlexander Motin 			goto out;
1431f6ad3f23SAlexander Motin 		}
1432f6ad3f23SAlexander Motin 		sestype->hdr  = cur_buf_type;
1433f6ad3f23SAlexander Motin 		sestype->text = type_text;
1434f6ad3f23SAlexander Motin 		type_text += cur_buf_type->etype_txt_len;
14355e6609a2SMatt Jacob 		ENC_VLOG(enc, " Type Desc[%d]: Type 0x%x, MaxElt %d, In Subenc "
1436f6ad3f23SAlexander Motin 		    "%d, Text Length %d: %.*s\n", sestype - ses_types,
1437f6ad3f23SAlexander Motin 		    sestype->hdr->etype_elm_type, sestype->hdr->etype_maxelt,
1438f6ad3f23SAlexander Motin 		    sestype->hdr->etype_subenc, sestype->hdr->etype_txt_len,
1439f6ad3f23SAlexander Motin 		    sestype->hdr->etype_txt_len, sestype->text);
1440f6ad3f23SAlexander Motin 
1441f6ad3f23SAlexander Motin 		nelm += sestype->hdr->etype_maxelt
1442f6ad3f23SAlexander Motin 		      + /*overall status element*/1;
1443f6ad3f23SAlexander Motin 		sestype++;
1444f6ad3f23SAlexander Motin 		cur_buf_type++;
1445f6ad3f23SAlexander Motin 	}
1446f6ad3f23SAlexander Motin 
1447f6ad3f23SAlexander Motin 	/* Create the object map. */
1448f6ad3f23SAlexander Motin 	enc_cache->elm_map = ENC_MALLOCZ(nelm * sizeof(enc_element_t));
1449f6ad3f23SAlexander Motin 	if (enc_cache->elm_map == NULL) {
1450f6ad3f23SAlexander Motin 		err = ENOMEM;
1451f6ad3f23SAlexander Motin 		goto out;
1452f6ad3f23SAlexander Motin 	}
1453f6ad3f23SAlexander Motin 	ses_cache->ses_ntypes = (uint8_t)ntype;
1454f6ad3f23SAlexander Motin 	enc_cache->nelms = nelm;
1455f6ad3f23SAlexander Motin 
1456f6ad3f23SAlexander Motin 	ses_iter_init(enc, enc_cache, &iter);
1457f6ad3f23SAlexander Motin 	while ((element = ses_iter_next(&iter)) != NULL) {
1458f6ad3f23SAlexander Motin 		const struct ses_elm_type_desc *thdr;
1459f6ad3f23SAlexander Motin 
1460f6ad3f23SAlexander Motin 		ENC_DLOG(enc, "%s: checking obj %d(%d,%d)\n", __func__,
1461f6ad3f23SAlexander Motin 		    iter.global_element_index, iter.type_index, nelm,
1462f6ad3f23SAlexander Motin 		    iter.type_element_index);
1463f6ad3f23SAlexander Motin 		thdr = ses_cache->ses_types[iter.type_index].hdr;
1464f6ad3f23SAlexander Motin 		element->subenclosure = thdr->etype_subenc;
1465f6ad3f23SAlexander Motin 		element->enctype = thdr->etype_elm_type;
1466f6ad3f23SAlexander Motin 		element->overall_status_elem = iter.type_element_index == 0;
1467f6ad3f23SAlexander Motin 		element->elm_private = ENC_MALLOCZ(sizeof(ses_element_t));
1468f6ad3f23SAlexander Motin 		if (element->elm_private == NULL) {
1469f6ad3f23SAlexander Motin 			err = ENOMEM;
1470f6ad3f23SAlexander Motin 			goto out;
1471f6ad3f23SAlexander Motin 		}
1472f6ad3f23SAlexander Motin 		ENC_DLOG(enc, "%s: creating elmpriv %d(%d,%d) subenc %d "
1473f6ad3f23SAlexander Motin 		    "type 0x%x\n", __func__, iter.global_element_index,
1474f6ad3f23SAlexander Motin 		    iter.type_index, iter.type_element_index,
1475f6ad3f23SAlexander Motin 		    thdr->etype_subenc, thdr->etype_elm_type);
1476f6ad3f23SAlexander Motin 	}
1477f6ad3f23SAlexander Motin 
1478f6ad3f23SAlexander Motin 	err = 0;
1479f6ad3f23SAlexander Motin 
1480f6ad3f23SAlexander Motin out:
1481f6ad3f23SAlexander Motin 	if (err)
1482262b5c50SAlexander Motin 		ses_cache_free(enc, enc_cache);
1483f6ad3f23SAlexander Motin 	else {
1484f6ad3f23SAlexander Motin 		enc_update_request(enc, SES_UPDATE_GETSTATUS);
1485f6ad3f23SAlexander Motin 		enc_update_request(enc, SES_UPDATE_GETELMDESCS);
1486f6ad3f23SAlexander Motin 		if (ses->ses_flags & SES_FLAG_ADDLSTATUS)
1487f6ad3f23SAlexander Motin 			enc_update_request(enc, SES_UPDATE_GETELMADDLSTATUS);
1488f6ad3f23SAlexander Motin 		enc_update_request(enc, SES_PUBLISH_CACHE);
1489f6ad3f23SAlexander Motin 	}
1490f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "%s: exiting with err %d\n", __func__, err);
1491f6ad3f23SAlexander Motin 	return (err);
1492f6ad3f23SAlexander Motin }
1493f6ad3f23SAlexander Motin 
1494f6ad3f23SAlexander Motin /**
1495f6ad3f23SAlexander Motin  * \brief Update the status page and associated structures.
1496f6ad3f23SAlexander Motin  *
1497f6ad3f23SAlexander Motin  * \param enc   SES softc to update for.
1498f6ad3f23SAlexander Motin  * \param buf   Buffer containing the status page.
1499f6ad3f23SAlexander Motin  * \param bufsz	Amount of data in the buffer.
1500f6ad3f23SAlexander Motin  *
1501f6ad3f23SAlexander Motin  * \return	0 on success, errno otherwise.
1502f6ad3f23SAlexander Motin  */
1503f6ad3f23SAlexander Motin static int
1504f6ad3f23SAlexander Motin ses_process_status(enc_softc_t *enc, struct enc_fsm_state *state,
1505f6ad3f23SAlexander Motin     union ccb *ccb, uint8_t **bufp, int error, int xfer_len)
1506f6ad3f23SAlexander Motin {
1507f6ad3f23SAlexander Motin 	struct ses_iterator iter;
1508f6ad3f23SAlexander Motin 	enc_element_t *element;
1509f6ad3f23SAlexander Motin 	ses_softc_t *ses;
1510f6ad3f23SAlexander Motin 	enc_cache_t *enc_cache;
1511f6ad3f23SAlexander Motin 	ses_cache_t *ses_cache;
1512f6ad3f23SAlexander Motin 	uint8_t *buf;
1513f6ad3f23SAlexander Motin 	int err = -1;
1514f6ad3f23SAlexander Motin 	int length;
1515f6ad3f23SAlexander Motin 	struct ses_status_page *page;
1516f6ad3f23SAlexander Motin 	union ses_status_element *cur_stat;
1517f6ad3f23SAlexander Motin 	union ses_status_element *last_stat;
1518f6ad3f23SAlexander Motin 
1519f6ad3f23SAlexander Motin 	ses = enc->enc_private;
1520f6ad3f23SAlexander Motin 	enc_cache = &enc->enc_daemon_cache;
1521f6ad3f23SAlexander Motin 	ses_cache = enc_cache->private;
1522f6ad3f23SAlexander Motin 	buf = *bufp;
1523f6ad3f23SAlexander Motin 
1524f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "%s: enter (%p, %p, %d)\n", __func__, enc, buf, xfer_len);
1525f6ad3f23SAlexander Motin 	page = (struct ses_status_page *)buf;
1526f6ad3f23SAlexander Motin 	length = ses_page_length(&page->hdr);
1527f6ad3f23SAlexander Motin 
1528f6ad3f23SAlexander Motin 	if (error != 0) {
1529f6ad3f23SAlexander Motin 		err = error;
1530f6ad3f23SAlexander Motin 		goto out;
1531f6ad3f23SAlexander Motin 	}
1532f6ad3f23SAlexander Motin 	/*
1533f6ad3f23SAlexander Motin 	 * Make sure the length fits in the buffer.
1534f6ad3f23SAlexander Motin 	 *
1535f6ad3f23SAlexander Motin 	 * XXX all this means is that the page is larger than the space
1536f6ad3f23SAlexander Motin 	 * we allocated.  Since we use a statically sized buffer, this
1537f6ad3f23SAlexander Motin 	 * could happen... Need to use dynamic discovery of the size.
1538f6ad3f23SAlexander Motin 	 */
1539f6ad3f23SAlexander Motin 	if (length > xfer_len) {
15405e6609a2SMatt Jacob 		ENC_VLOG(enc, "Enclosure Status Page Too Long\n");
1541f6ad3f23SAlexander Motin 		goto out;
1542f6ad3f23SAlexander Motin 	}
1543f6ad3f23SAlexander Motin 	/* Make sure the length contains at least one header and status */
1544f6ad3f23SAlexander Motin 	if (length < (sizeof(*page) + sizeof(*page->elements))) {
15455e6609a2SMatt Jacob 		ENC_VLOG(enc, "Enclosure Status Page Too Short\n");
1546f6ad3f23SAlexander Motin 		goto out;
1547f6ad3f23SAlexander Motin 	}
1548f6ad3f23SAlexander Motin 
1549f6ad3f23SAlexander Motin 	if (!ses_config_cache_valid(ses_cache, page->hdr.gen_code)) {
1550f6ad3f23SAlexander Motin 		ENC_DLOG(enc, "%s: Generation count change detected\n",
1551f6ad3f23SAlexander Motin 		    __func__);
1552f6ad3f23SAlexander Motin 		enc_update_request(enc, SES_UPDATE_GETCONFIG);
1553f6ad3f23SAlexander Motin 		goto out;
1554f6ad3f23SAlexander Motin 	}
1555f6ad3f23SAlexander Motin 
1556f6ad3f23SAlexander Motin 	ses_cache_free_status(enc, enc_cache);
1557f6ad3f23SAlexander Motin 	ses_cache->status_page = page;
1558f6ad3f23SAlexander Motin 	*bufp = NULL;
1559f6ad3f23SAlexander Motin 
1560f6ad3f23SAlexander Motin 	enc_cache->enc_status = page->hdr.page_specific_flags;
1561f6ad3f23SAlexander Motin 
1562f6ad3f23SAlexander Motin 	/*
1563f6ad3f23SAlexander Motin 	 * Read in individual element status.  The element order
1564f6ad3f23SAlexander Motin 	 * matches the order reported in the config page (i.e. the
1565f6ad3f23SAlexander Motin 	 * order of an unfiltered iteration of the config objects)..
1566f6ad3f23SAlexander Motin 	 */
1567f6ad3f23SAlexander Motin 	ses_iter_init(enc, enc_cache, &iter);
1568f6ad3f23SAlexander Motin 	cur_stat  = page->elements;
1569f6ad3f23SAlexander Motin 	last_stat = (union ses_status_element *)
1570f6ad3f23SAlexander Motin 	    &buf[length - sizeof(*last_stat)];
1571f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "%s: total page length %d, xfer_len %d\n",
1572f6ad3f23SAlexander Motin 		__func__, length, xfer_len);
1573f6ad3f23SAlexander Motin 	while (cur_stat <= last_stat
1574f6ad3f23SAlexander Motin 	    && (element = ses_iter_next(&iter)) != NULL) {
1575f6ad3f23SAlexander Motin 
1576f6ad3f23SAlexander Motin 		ENC_DLOG(enc, "%s: obj %d(%d,%d) off=0x%tx status=%jx\n",
1577f6ad3f23SAlexander Motin 		    __func__, iter.global_element_index, iter.type_index,
1578f6ad3f23SAlexander Motin 		    iter.type_element_index, (uint8_t *)cur_stat - buf,
1579f6ad3f23SAlexander Motin 		    scsi_4btoul(cur_stat->bytes));
1580f6ad3f23SAlexander Motin 
1581f6ad3f23SAlexander Motin 		memcpy(&element->encstat, cur_stat, sizeof(element->encstat));
1582f6ad3f23SAlexander Motin 		element->svalid = 1;
1583f6ad3f23SAlexander Motin 		cur_stat++;
1584f6ad3f23SAlexander Motin 	}
1585f6ad3f23SAlexander Motin 
1586f6ad3f23SAlexander Motin 	if (ses_iter_next(&iter) != NULL) {
15875e6609a2SMatt Jacob 		ENC_VLOG(enc, "Status page, length insufficient for "
1588f6ad3f23SAlexander Motin 			"expected number of objects\n");
1589f6ad3f23SAlexander Motin 	} else {
1590f6ad3f23SAlexander Motin 		if (cur_stat <= last_stat)
15915e6609a2SMatt Jacob 			ENC_VLOG(enc, "Status page, exhausted objects before "
1592f6ad3f23SAlexander Motin 				"exhausing page\n");
1593f6ad3f23SAlexander Motin 		enc_update_request(enc, SES_PUBLISH_CACHE);
1594f6ad3f23SAlexander Motin 		err = 0;
1595f6ad3f23SAlexander Motin 	}
1596f6ad3f23SAlexander Motin out:
1597f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "%s: exiting with error %d\n", __func__, err);
1598f6ad3f23SAlexander Motin 	return (err);
1599f6ad3f23SAlexander Motin }
1600f6ad3f23SAlexander Motin 
1601f6ad3f23SAlexander Motin typedef enum {
1602f6ad3f23SAlexander Motin 	/**
1603f6ad3f23SAlexander Motin 	 * The enclosure should not provide additional element
1604f6ad3f23SAlexander Motin 	 * status for this element type in page 0x0A.
1605f6ad3f23SAlexander Motin 	 *
1606f6ad3f23SAlexander Motin 	 * \note  This status is returned for any types not
1607f6ad3f23SAlexander Motin 	 *        listed SES3r02.  Further types added in a
1608f6ad3f23SAlexander Motin 	 *        future specification will be incorrectly
1609f6ad3f23SAlexander Motin 	 *        classified.
1610f6ad3f23SAlexander Motin 	 */
1611f6ad3f23SAlexander Motin 	TYPE_ADDLSTATUS_NONE,
1612f6ad3f23SAlexander Motin 
1613f6ad3f23SAlexander Motin 	/**
1614f6ad3f23SAlexander Motin 	 * The element type provides additional element status
1615f6ad3f23SAlexander Motin 	 * in page 0x0A.
1616f6ad3f23SAlexander Motin 	 */
1617f6ad3f23SAlexander Motin 	TYPE_ADDLSTATUS_MANDATORY,
1618f6ad3f23SAlexander Motin 
1619f6ad3f23SAlexander Motin 	/**
1620f6ad3f23SAlexander Motin 	 * The element type may provide additional element status
1621f6ad3f23SAlexander Motin 	 * in page 0x0A, but i
1622f6ad3f23SAlexander Motin 	 */
1623f6ad3f23SAlexander Motin 	TYPE_ADDLSTATUS_OPTIONAL
1624f6ad3f23SAlexander Motin } ses_addlstatus_avail_t;
1625f6ad3f23SAlexander Motin 
1626f6ad3f23SAlexander Motin /**
1627f6ad3f23SAlexander Motin  * \brief Check to see whether a given type (as obtained via type headers) is
1628f6ad3f23SAlexander Motin  *	  supported by the additional status command.
1629f6ad3f23SAlexander Motin  *
1630f6ad3f23SAlexander Motin  * \param enc     SES softc to check.
1631f6ad3f23SAlexander Motin  * \param typidx  Type index to check for.
1632f6ad3f23SAlexander Motin  *
1633f6ad3f23SAlexander Motin  * \return  An enumeration indicating if additional status is mandatory,
1634f6ad3f23SAlexander Motin  *          optional, or not required for this type.
1635f6ad3f23SAlexander Motin  */
1636f6ad3f23SAlexander Motin static ses_addlstatus_avail_t
1637f6ad3f23SAlexander Motin ses_typehasaddlstatus(enc_softc_t *enc, uint8_t typidx)
1638f6ad3f23SAlexander Motin {
1639f6ad3f23SAlexander Motin 	enc_cache_t *enc_cache;
1640f6ad3f23SAlexander Motin 	ses_cache_t *ses_cache;
1641f6ad3f23SAlexander Motin 
1642f6ad3f23SAlexander Motin 	enc_cache = &enc->enc_daemon_cache;
1643f6ad3f23SAlexander Motin 	ses_cache = enc_cache->private;
1644f6ad3f23SAlexander Motin 	switch(ses_cache->ses_types[typidx].hdr->etype_elm_type) {
1645f6ad3f23SAlexander Motin 	case ELMTYP_DEVICE:
1646f6ad3f23SAlexander Motin 	case ELMTYP_ARRAY_DEV:
1647f6ad3f23SAlexander Motin 	case ELMTYP_SAS_EXP:
1648f6ad3f23SAlexander Motin 		return (TYPE_ADDLSTATUS_MANDATORY);
1649f6ad3f23SAlexander Motin 	case ELMTYP_SCSI_INI:
1650f6ad3f23SAlexander Motin 	case ELMTYP_SCSI_TGT:
1651f6ad3f23SAlexander Motin 	case ELMTYP_ESCC:
1652f6ad3f23SAlexander Motin 		return (TYPE_ADDLSTATUS_OPTIONAL);
1653f6ad3f23SAlexander Motin 	default:
1654f6ad3f23SAlexander Motin 		/* No additional status information available. */
1655f6ad3f23SAlexander Motin 		break;
1656f6ad3f23SAlexander Motin 	}
1657f6ad3f23SAlexander Motin 	return (TYPE_ADDLSTATUS_NONE);
1658f6ad3f23SAlexander Motin }
1659f6ad3f23SAlexander Motin 
1660f6ad3f23SAlexander Motin static int ses_get_elm_addlstatus_fc(enc_softc_t *, enc_cache_t *,
1661f6ad3f23SAlexander Motin 				     uint8_t *, int);
1662f6ad3f23SAlexander Motin static int ses_get_elm_addlstatus_sas(enc_softc_t *, enc_cache_t *, uint8_t *,
1663f6ad3f23SAlexander Motin 				      int, int, int, int);
1664f6ad3f23SAlexander Motin 
1665f6ad3f23SAlexander Motin /**
1666f6ad3f23SAlexander Motin  * \brief Parse the additional status element data for each object.
1667f6ad3f23SAlexander Motin  *
1668f6ad3f23SAlexander Motin  * \param enc       The SES softc to update.
1669f6ad3f23SAlexander Motin  * \param buf       The buffer containing the additional status
1670f6ad3f23SAlexander Motin  *                  element response.
1671f6ad3f23SAlexander Motin  * \param xfer_len  Size of the buffer.
1672f6ad3f23SAlexander Motin  *
1673f6ad3f23SAlexander Motin  * \return  0 on success, errno otherwise.
1674f6ad3f23SAlexander Motin  */
1675f6ad3f23SAlexander Motin static int
1676f6ad3f23SAlexander Motin ses_process_elm_addlstatus(enc_softc_t *enc, struct enc_fsm_state *state,
1677f6ad3f23SAlexander Motin     union ccb *ccb, uint8_t **bufp, int error, int xfer_len)
1678f6ad3f23SAlexander Motin {
1679f6ad3f23SAlexander Motin 	struct ses_iterator iter, titer;
1680f6ad3f23SAlexander Motin 	int eip;
1681f6ad3f23SAlexander Motin 	int err;
1682f6ad3f23SAlexander Motin 	int ignore_index = 0;
1683f6ad3f23SAlexander Motin 	int length;
1684f6ad3f23SAlexander Motin 	int offset;
1685f6ad3f23SAlexander Motin 	enc_cache_t *enc_cache;
1686f6ad3f23SAlexander Motin 	ses_cache_t *ses_cache;
1687f6ad3f23SAlexander Motin 	uint8_t *buf;
1688f6ad3f23SAlexander Motin 	ses_element_t *elmpriv;
1689f6ad3f23SAlexander Motin 	const struct ses_page_hdr *hdr;
1690f6ad3f23SAlexander Motin 	enc_element_t *element, *telement;
1691f6ad3f23SAlexander Motin 
1692f6ad3f23SAlexander Motin 	enc_cache = &enc->enc_daemon_cache;
1693f6ad3f23SAlexander Motin 	ses_cache = enc_cache->private;
1694f6ad3f23SAlexander Motin 	buf = *bufp;
1695f6ad3f23SAlexander Motin 	err = -1;
1696f6ad3f23SAlexander Motin 
1697f6ad3f23SAlexander Motin 	if (error != 0) {
1698f6ad3f23SAlexander Motin 		err = error;
1699f6ad3f23SAlexander Motin 		goto out;
1700f6ad3f23SAlexander Motin 	}
1701f6ad3f23SAlexander Motin 	ses_cache_free_elm_addlstatus(enc, enc_cache);
1702f6ad3f23SAlexander Motin 	ses_cache->elm_addlstatus_page =
1703f6ad3f23SAlexander Motin 	    (struct ses_addl_elem_status_page *)buf;
1704f6ad3f23SAlexander Motin 	*bufp = NULL;
1705f6ad3f23SAlexander Motin 
1706f6ad3f23SAlexander Motin 	/*
1707f6ad3f23SAlexander Motin 	 * The objects appear in the same order here as in Enclosure Status,
1708f6ad3f23SAlexander Motin 	 * which itself is ordered by the Type Descriptors from the Config
1709f6ad3f23SAlexander Motin 	 * page.  However, it is necessary to skip elements that are not
1710f6ad3f23SAlexander Motin 	 * supported by this page when counting them.
1711f6ad3f23SAlexander Motin 	 */
1712f6ad3f23SAlexander Motin 	hdr = &ses_cache->elm_addlstatus_page->hdr;
1713f6ad3f23SAlexander Motin 	length = ses_page_length(hdr);
1714f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "Additional Element Status Page Length 0x%x\n", length);
1715f6ad3f23SAlexander Motin 	/* Make sure the length includes at least one header. */
1716f6ad3f23SAlexander Motin 	if (length < sizeof(*hdr)+sizeof(struct ses_elm_addlstatus_base_hdr)) {
17175e6609a2SMatt Jacob 		ENC_VLOG(enc, "Runt Additional Element Status Page\n");
1718f6ad3f23SAlexander Motin 		goto out;
1719f6ad3f23SAlexander Motin 	}
1720f6ad3f23SAlexander Motin 	if (length > xfer_len) {
17215e6609a2SMatt Jacob 		ENC_VLOG(enc, "Additional Element Status Page Too Long\n");
1722f6ad3f23SAlexander Motin 		goto out;
1723f6ad3f23SAlexander Motin 	}
1724f6ad3f23SAlexander Motin 
1725f6ad3f23SAlexander Motin 	if (!ses_config_cache_valid(ses_cache, hdr->gen_code)) {
1726f6ad3f23SAlexander Motin 		ENC_DLOG(enc, "%s: Generation count change detected\n",
1727f6ad3f23SAlexander Motin 		    __func__);
1728f6ad3f23SAlexander Motin 		enc_update_request(enc, SES_UPDATE_GETCONFIG);
1729f6ad3f23SAlexander Motin 		goto out;
1730f6ad3f23SAlexander Motin 	}
1731f6ad3f23SAlexander Motin 
1732f6ad3f23SAlexander Motin 	offset = sizeof(struct ses_page_hdr);
1733f6ad3f23SAlexander Motin 	ses_iter_init(enc, enc_cache, &iter);
1734f6ad3f23SAlexander Motin 	while (offset < length
1735f6ad3f23SAlexander Motin 	    && (element = ses_iter_next(&iter)) != NULL) {
1736f6ad3f23SAlexander Motin 		struct ses_elm_addlstatus_base_hdr *elm_hdr;
1737f6ad3f23SAlexander Motin 		int proto_info_len;
1738f6ad3f23SAlexander Motin 		ses_addlstatus_avail_t status_type;
1739f6ad3f23SAlexander Motin 
1740f6ad3f23SAlexander Motin 		/*
1741f6ad3f23SAlexander Motin 		 * Additional element status is only provided for
1742f6ad3f23SAlexander Motin 		 * individual elements (i.e. overal status elements
1743f6ad3f23SAlexander Motin 		 * are excluded) and those of the types specified
1744f6ad3f23SAlexander Motin 		 * in the SES spec.
1745f6ad3f23SAlexander Motin 		 */
1746f6ad3f23SAlexander Motin 		status_type = ses_typehasaddlstatus(enc, iter.type_index);
1747f6ad3f23SAlexander Motin 		if (iter.individual_element_index == ITERATOR_INDEX_INVALID
1748f6ad3f23SAlexander Motin 		 || status_type == TYPE_ADDLSTATUS_NONE)
1749f6ad3f23SAlexander Motin 			continue;
1750f6ad3f23SAlexander Motin 
1751f6ad3f23SAlexander Motin 		elm_hdr = (struct ses_elm_addlstatus_base_hdr *)&buf[offset];
1752f6ad3f23SAlexander Motin 		eip = ses_elm_addlstatus_eip(elm_hdr);
1753f6ad3f23SAlexander Motin 		if (eip && !ignore_index) {
1754f6ad3f23SAlexander Motin 			struct ses_elm_addlstatus_eip_hdr *eip_hdr;
1755f6ad3f23SAlexander Motin 			int expected_index;
1756f6ad3f23SAlexander Motin 
1757f6ad3f23SAlexander Motin 			eip_hdr = (struct ses_elm_addlstatus_eip_hdr *)elm_hdr;
1758f6ad3f23SAlexander Motin 			expected_index = iter.individual_element_index;
1759f6ad3f23SAlexander Motin 			titer = iter;
1760f6ad3f23SAlexander Motin 			telement = ses_iter_seek_to(&titer,
1761f6ad3f23SAlexander Motin 						   eip_hdr->element_index,
1762f6ad3f23SAlexander Motin 						   SES_ELEM_INDEX_INDIVIDUAL);
1763f6ad3f23SAlexander Motin 			if (telement != NULL &&
1764f6ad3f23SAlexander Motin 			    (ses_typehasaddlstatus(enc, titer.type_index) !=
1765f6ad3f23SAlexander Motin 			     TYPE_ADDLSTATUS_NONE ||
1766f6ad3f23SAlexander Motin 			     titer.type_index > ELMTYP_SAS_CONN)) {
1767f6ad3f23SAlexander Motin 				iter = titer;
1768f6ad3f23SAlexander Motin 				element = telement;
1769f6ad3f23SAlexander Motin 			} else
1770f6ad3f23SAlexander Motin 				ignore_index = 1;
1771f6ad3f23SAlexander Motin 
1772f6ad3f23SAlexander Motin 			if (iter.individual_element_index > expected_index
1773f6ad3f23SAlexander Motin 			 && status_type == TYPE_ADDLSTATUS_MANDATORY) {
17745e6609a2SMatt Jacob 				ENC_VLOG(enc, "%s: provided element "
1775f6ad3f23SAlexander Motin 					"index %d skips mandatory status "
1776f6ad3f23SAlexander Motin 					" element at index %d\n",
1777f6ad3f23SAlexander Motin 					__func__, eip_hdr->element_index,
1778f6ad3f23SAlexander Motin 					expected_index);
1779f6ad3f23SAlexander Motin 			}
1780f6ad3f23SAlexander Motin 		}
1781f6ad3f23SAlexander Motin 		elmpriv = element->elm_private;
1782f6ad3f23SAlexander Motin 		elmpriv->addl.hdr = elm_hdr;
1783f6ad3f23SAlexander Motin 		ENC_DLOG(enc, "%s: global element index=%d, type index=%d "
1784f6ad3f23SAlexander Motin 		    "type element index=%d, offset=0x%x, "
1785f6ad3f23SAlexander Motin 		    "byte0=0x%x, length=0x%x\n", __func__,
1786f6ad3f23SAlexander Motin 		    iter.global_element_index, iter.type_index,
1787f6ad3f23SAlexander Motin 		    iter.type_element_index, offset, elmpriv->addl.hdr->byte0,
1788f6ad3f23SAlexander Motin 		    elmpriv->addl.hdr->length);
1789f6ad3f23SAlexander Motin 
1790f6ad3f23SAlexander Motin 		/* Skip to after the length field */
1791f6ad3f23SAlexander Motin 		offset += sizeof(struct ses_elm_addlstatus_base_hdr);
1792f6ad3f23SAlexander Motin 
1793f6ad3f23SAlexander Motin 		/* Make sure the descriptor is within bounds */
1794f6ad3f23SAlexander Motin 		if ((offset + elmpriv->addl.hdr->length) > length) {
17955e6609a2SMatt Jacob 			ENC_VLOG(enc, "Element %d Beyond End "
1796f6ad3f23SAlexander Motin 			    "of Additional Element Status Descriptors\n",
1797f6ad3f23SAlexander Motin 			    iter.global_element_index);
1798f6ad3f23SAlexander Motin 			err = EIO;
1799f6ad3f23SAlexander Motin 			goto out;
1800f6ad3f23SAlexander Motin 		}
1801f6ad3f23SAlexander Motin 
1802f6ad3f23SAlexander Motin 		/* Advance to the protocol data, skipping eip bytes if needed */
1803f6ad3f23SAlexander Motin 		offset += (eip * SES_EIP_HDR_EXTRA_LEN);
1804f6ad3f23SAlexander Motin 		proto_info_len = elmpriv->addl.hdr->length
1805f6ad3f23SAlexander Motin 			       - (eip * SES_EIP_HDR_EXTRA_LEN);
1806f6ad3f23SAlexander Motin 
1807f6ad3f23SAlexander Motin 		/* Errors in this block are ignored as they are non-fatal */
1808f6ad3f23SAlexander Motin 		switch(ses_elm_addlstatus_proto(elmpriv->addl.hdr)) {
1809f6ad3f23SAlexander Motin 		case SPSP_PROTO_FC:
1810f6ad3f23SAlexander Motin 			if (elmpriv->addl.hdr->length == 0)
1811f6ad3f23SAlexander Motin 				break;
1812f6ad3f23SAlexander Motin 			ses_get_elm_addlstatus_fc(enc, enc_cache,
1813f6ad3f23SAlexander Motin 						  &buf[offset], proto_info_len);
1814f6ad3f23SAlexander Motin 			break;
1815f6ad3f23SAlexander Motin 		case SPSP_PROTO_SAS:
1816f6ad3f23SAlexander Motin 			if (elmpriv->addl.hdr->length <= 2)
1817f6ad3f23SAlexander Motin 				break;
1818f6ad3f23SAlexander Motin 			ses_get_elm_addlstatus_sas(enc, enc_cache,
1819f6ad3f23SAlexander Motin 						   &buf[offset],
1820f6ad3f23SAlexander Motin 						   proto_info_len,
1821f6ad3f23SAlexander Motin 						   eip, iter.type_index,
1822f6ad3f23SAlexander Motin 						   iter.global_element_index);
1823f6ad3f23SAlexander Motin 			break;
1824f6ad3f23SAlexander Motin 		default:
18255e6609a2SMatt Jacob 			ENC_VLOG(enc, "Element %d: Unknown Additional Element "
1826f6ad3f23SAlexander Motin 			    "Protocol 0x%x\n", iter.global_element_index,
1827f6ad3f23SAlexander Motin 			    ses_elm_addlstatus_proto(elmpriv->addl.hdr));
1828f6ad3f23SAlexander Motin 			goto out;
1829f6ad3f23SAlexander Motin 		}
1830f6ad3f23SAlexander Motin 
1831f6ad3f23SAlexander Motin 		offset += proto_info_len;
1832f6ad3f23SAlexander Motin 	}
1833f6ad3f23SAlexander Motin 	err = 0;
1834f6ad3f23SAlexander Motin out:
1835f6ad3f23SAlexander Motin 	if (err)
1836f6ad3f23SAlexander Motin 		ses_cache_free_elm_addlstatus(enc, enc_cache);
1837f6ad3f23SAlexander Motin 	enc_update_request(enc, SES_PUBLISH_PHYSPATHS);
1838f6ad3f23SAlexander Motin 	enc_update_request(enc, SES_PUBLISH_CACHE);
1839f6ad3f23SAlexander Motin 	return (err);
1840f6ad3f23SAlexander Motin }
1841f6ad3f23SAlexander Motin 
1842f6ad3f23SAlexander Motin static int
1843f6ad3f23SAlexander Motin ses_process_control_request(enc_softc_t *enc, struct enc_fsm_state *state,
1844f6ad3f23SAlexander Motin     union ccb *ccb, uint8_t **bufp, int error, int xfer_len)
1845f6ad3f23SAlexander Motin {
1846f6ad3f23SAlexander Motin 	ses_softc_t *ses;
1847f6ad3f23SAlexander Motin 
1848f6ad3f23SAlexander Motin 	ses = enc->enc_private;
1849f6ad3f23SAlexander Motin 	/*
1850f6ad3f23SAlexander Motin 	 * Possible errors:
1851f6ad3f23SAlexander Motin 	 *  o Generation count wrong.
1852f6ad3f23SAlexander Motin 	 *  o Some SCSI status error.
1853f6ad3f23SAlexander Motin 	 */
1854f6ad3f23SAlexander Motin 	ses_terminate_control_requests(&ses->ses_pending_requests, error);
1855f6ad3f23SAlexander Motin 	enc_update_request(enc, SES_UPDATE_GETSTATUS);
1856f6ad3f23SAlexander Motin 	return (0);
1857f6ad3f23SAlexander Motin }
1858f6ad3f23SAlexander Motin 
1859f6ad3f23SAlexander Motin static int
1860f6ad3f23SAlexander Motin ses_publish_physpaths(enc_softc_t *enc, struct enc_fsm_state *state,
1861f6ad3f23SAlexander Motin     union ccb *ccb, uint8_t **bufp, int error, int xfer_len)
1862f6ad3f23SAlexander Motin {
1863f6ad3f23SAlexander Motin 	struct ses_iterator iter;
1864f6ad3f23SAlexander Motin 	enc_cache_t *enc_cache;
1865f6ad3f23SAlexander Motin 	ses_cache_t *ses_cache;
1866f6ad3f23SAlexander Motin 	enc_element_t *element;
1867f6ad3f23SAlexander Motin 
1868f6ad3f23SAlexander Motin 	enc_cache = &enc->enc_daemon_cache;
1869f6ad3f23SAlexander Motin 	ses_cache = enc_cache->private;
1870f6ad3f23SAlexander Motin 
1871f6ad3f23SAlexander Motin 	ses_iter_init(enc, enc_cache, &iter);
1872f6ad3f23SAlexander Motin 	while ((element = ses_iter_next(&iter)) != NULL) {
1873f6ad3f23SAlexander Motin 		/*
1874f6ad3f23SAlexander Motin 		 * ses_set_physpath() returns success if we changed
1875f6ad3f23SAlexander Motin 		 * the physpath of any element.  This allows us to
1876f6ad3f23SAlexander Motin 		 * only announce devices once regardless of how
1877f6ad3f23SAlexander Motin 		 * many times we process additional element status.
1878f6ad3f23SAlexander Motin 		 */
1879f6ad3f23SAlexander Motin 		if (ses_set_physpath(enc, element, &iter) == 0)
1880f6ad3f23SAlexander Motin 			ses_print_addl_data(enc, element);
1881f6ad3f23SAlexander Motin 	}
1882f6ad3f23SAlexander Motin 
1883f6ad3f23SAlexander Motin 	return (0);
1884f6ad3f23SAlexander Motin }
1885f6ad3f23SAlexander Motin 
1886f6ad3f23SAlexander Motin static int
1887f6ad3f23SAlexander Motin ses_publish_cache(enc_softc_t *enc, struct enc_fsm_state *state,
1888f6ad3f23SAlexander Motin     union ccb *ccb, uint8_t **bufp, int error, int xfer_len)
1889f6ad3f23SAlexander Motin {
1890f6ad3f23SAlexander Motin 
1891f6ad3f23SAlexander Motin 	sx_xlock(&enc->enc_cache_lock);
1892f6ad3f23SAlexander Motin 	ses_cache_clone(enc, /*src*/&enc->enc_daemon_cache,
1893f6ad3f23SAlexander Motin 			/*dst*/&enc->enc_cache);
1894f6ad3f23SAlexander Motin 	sx_xunlock(&enc->enc_cache_lock);
1895f6ad3f23SAlexander Motin 
1896f6ad3f23SAlexander Motin 	return (0);
1897f6ad3f23SAlexander Motin }
1898f6ad3f23SAlexander Motin 
1899f6ad3f23SAlexander Motin /**
1900f6ad3f23SAlexander Motin  * \brief Parse the descriptors for each object.
1901f6ad3f23SAlexander Motin  *
1902f6ad3f23SAlexander Motin  * \param enc       The SES softc to update.
1903f6ad3f23SAlexander Motin  * \param buf       The buffer containing the descriptor list response.
1904f6ad3f23SAlexander Motin  * \param xfer_len  Size of the buffer.
1905f6ad3f23SAlexander Motin  *
1906f6ad3f23SAlexander Motin  * \return	0 on success, errno otherwise.
1907f6ad3f23SAlexander Motin  */
1908f6ad3f23SAlexander Motin static int
1909f6ad3f23SAlexander Motin ses_process_elm_descs(enc_softc_t *enc, struct enc_fsm_state *state,
1910f6ad3f23SAlexander Motin     union ccb *ccb, uint8_t **bufp, int error, int xfer_len)
1911f6ad3f23SAlexander Motin {
1912f6ad3f23SAlexander Motin 	ses_softc_t *ses;
1913f6ad3f23SAlexander Motin 	struct ses_iterator iter;
1914f6ad3f23SAlexander Motin 	enc_element_t *element;
1915f6ad3f23SAlexander Motin 	int err;
1916f6ad3f23SAlexander Motin 	int offset;
1917f6ad3f23SAlexander Motin 	u_long length, plength;
1918f6ad3f23SAlexander Motin 	enc_cache_t *enc_cache;
1919f6ad3f23SAlexander Motin 	ses_cache_t *ses_cache;
1920f6ad3f23SAlexander Motin 	uint8_t *buf;
1921f6ad3f23SAlexander Motin 	ses_element_t *elmpriv;
1922f6ad3f23SAlexander Motin 	const struct ses_page_hdr *phdr;
1923f6ad3f23SAlexander Motin 	const struct ses_elm_desc_hdr *hdr;
1924f6ad3f23SAlexander Motin 
1925f6ad3f23SAlexander Motin 	ses = enc->enc_private;
1926f6ad3f23SAlexander Motin 	enc_cache = &enc->enc_daemon_cache;
1927f6ad3f23SAlexander Motin 	ses_cache = enc_cache->private;
1928f6ad3f23SAlexander Motin 	buf = *bufp;
1929f6ad3f23SAlexander Motin 	err = -1;
1930f6ad3f23SAlexander Motin 
1931f6ad3f23SAlexander Motin 	if (error != 0) {
1932f6ad3f23SAlexander Motin 		err = error;
1933f6ad3f23SAlexander Motin 		goto out;
1934f6ad3f23SAlexander Motin 	}
1935f6ad3f23SAlexander Motin 	ses_cache_free_elm_descs(enc, enc_cache);
1936f6ad3f23SAlexander Motin 	ses_cache->elm_descs_page = (struct ses_elem_descr_page *)buf;
1937f6ad3f23SAlexander Motin 	*bufp = NULL;
1938f6ad3f23SAlexander Motin 
1939f6ad3f23SAlexander Motin 	phdr = &ses_cache->elm_descs_page->hdr;
1940f6ad3f23SAlexander Motin 	plength = ses_page_length(phdr);
1941f6ad3f23SAlexander Motin 	if (xfer_len < sizeof(struct ses_page_hdr)) {
19425e6609a2SMatt Jacob 		ENC_VLOG(enc, "Runt Element Descriptor Page\n");
1943f6ad3f23SAlexander Motin 		goto out;
1944f6ad3f23SAlexander Motin 	}
1945f6ad3f23SAlexander Motin 	if (plength > xfer_len) {
19465e6609a2SMatt Jacob 		ENC_VLOG(enc, "Element Descriptor Page Too Long\n");
1947f6ad3f23SAlexander Motin 		goto out;
1948f6ad3f23SAlexander Motin 	}
1949f6ad3f23SAlexander Motin 
1950f6ad3f23SAlexander Motin 	if (!ses_config_cache_valid(ses_cache, phdr->gen_code)) {
1951f6ad3f23SAlexander Motin 		ENC_VLOG(enc, "%s: Generation count change detected\n",
1952f6ad3f23SAlexander Motin 		    __func__);
1953f6ad3f23SAlexander Motin 		enc_update_request(enc, SES_UPDATE_GETCONFIG);
1954f6ad3f23SAlexander Motin 		goto out;
1955f6ad3f23SAlexander Motin 	}
1956f6ad3f23SAlexander Motin 
1957f6ad3f23SAlexander Motin 	offset = sizeof(struct ses_page_hdr);
1958f6ad3f23SAlexander Motin 
1959f6ad3f23SAlexander Motin 	ses_iter_init(enc, enc_cache, &iter);
1960f6ad3f23SAlexander Motin 	while (offset < plength
1961f6ad3f23SAlexander Motin 	    && (element = ses_iter_next(&iter)) != NULL) {
1962f6ad3f23SAlexander Motin 
1963f6ad3f23SAlexander Motin 		if ((offset + sizeof(struct ses_elm_desc_hdr)) > plength) {
19645e6609a2SMatt Jacob 			ENC_VLOG(enc, "Element %d Descriptor Header Past "
1965f6ad3f23SAlexander Motin 			    "End of Buffer\n", iter.global_element_index);
1966f6ad3f23SAlexander Motin 			goto out;
1967f6ad3f23SAlexander Motin 		}
1968f6ad3f23SAlexander Motin 		hdr = (struct ses_elm_desc_hdr *)&buf[offset];
1969f6ad3f23SAlexander Motin 		length = scsi_2btoul(hdr->length);
1970f6ad3f23SAlexander Motin 		ENC_DLOG(enc, "%s: obj %d(%d,%d) length=%d off=%d\n", __func__,
1971f6ad3f23SAlexander Motin 		    iter.global_element_index, iter.type_index,
1972f6ad3f23SAlexander Motin 		    iter.type_element_index, length, offset);
1973f6ad3f23SAlexander Motin 		if ((offset + sizeof(*hdr) + length) > plength) {
19745e6609a2SMatt Jacob 			ENC_VLOG(enc, "Element%d Descriptor Past "
1975f6ad3f23SAlexander Motin 			    "End of Buffer\n", iter.global_element_index);
1976f6ad3f23SAlexander Motin 			goto out;
1977f6ad3f23SAlexander Motin 		}
1978f6ad3f23SAlexander Motin 		offset += sizeof(*hdr);
1979f6ad3f23SAlexander Motin 
1980f6ad3f23SAlexander Motin 		if (length > 0) {
1981f6ad3f23SAlexander Motin 			elmpriv = element->elm_private;
1982f6ad3f23SAlexander Motin 			elmpriv->descr_len = length;
1983f6ad3f23SAlexander Motin 			elmpriv->descr = &buf[offset];
1984f6ad3f23SAlexander Motin 		}
1985f6ad3f23SAlexander Motin 
1986f6ad3f23SAlexander Motin 		/* skip over the descriptor itself */
1987f6ad3f23SAlexander Motin 		offset += length;
1988f6ad3f23SAlexander Motin 	}
1989f6ad3f23SAlexander Motin 
1990f6ad3f23SAlexander Motin 	err = 0;
1991f6ad3f23SAlexander Motin out:
1992f6ad3f23SAlexander Motin 	if (err == 0) {
1993f6ad3f23SAlexander Motin 		if (ses->ses_flags & SES_FLAG_ADDLSTATUS)
1994f6ad3f23SAlexander Motin 			enc_update_request(enc, SES_UPDATE_GETELMADDLSTATUS);
1995f6ad3f23SAlexander Motin 	}
1996f6ad3f23SAlexander Motin 	enc_update_request(enc, SES_PUBLISH_CACHE);
1997f6ad3f23SAlexander Motin 	return (err);
1998f6ad3f23SAlexander Motin }
1999f6ad3f23SAlexander Motin 
2000f6ad3f23SAlexander Motin static int
2001f6ad3f23SAlexander Motin ses_fill_rcv_diag_io(enc_softc_t *enc, struct enc_fsm_state *state,
2002f6ad3f23SAlexander Motin 		       union ccb *ccb, uint8_t *buf)
2003f6ad3f23SAlexander Motin {
2004f6ad3f23SAlexander Motin 
2005f6ad3f23SAlexander Motin 	if (enc->enc_type == ENC_SEMB_SES) {
2006f6ad3f23SAlexander Motin 		semb_receive_diagnostic_results(&ccb->ataio, /*retries*/5,
2007f6ad3f23SAlexander Motin 					enc_done, MSG_SIMPLE_Q_TAG, /*pcv*/1,
2008f6ad3f23SAlexander Motin 					state->page_code, buf, state->buf_size,
2009f6ad3f23SAlexander Motin 					state->timeout);
2010f6ad3f23SAlexander Motin 	} else {
2011f6ad3f23SAlexander Motin 		scsi_receive_diagnostic_results(&ccb->csio, /*retries*/5,
2012f6ad3f23SAlexander Motin 					enc_done, MSG_SIMPLE_Q_TAG, /*pcv*/1,
2013f6ad3f23SAlexander Motin 					state->page_code, buf, state->buf_size,
2014f6ad3f23SAlexander Motin 					SSD_FULL_SIZE, state->timeout);
2015f6ad3f23SAlexander Motin 	}
2016f6ad3f23SAlexander Motin 	return (0);
2017f6ad3f23SAlexander Motin }
2018f6ad3f23SAlexander Motin 
2019f6ad3f23SAlexander Motin /**
2020f6ad3f23SAlexander Motin  * \brief Encode the object status into the response buffer, which is
2021f6ad3f23SAlexander Motin  *	  expected to contain the current enclosure status.  This function
2022f6ad3f23SAlexander Motin  *	  turns off all the 'select' bits for the objects except for the
2023f6ad3f23SAlexander Motin  *	  object specified, then sends it back to the enclosure.
2024f6ad3f23SAlexander Motin  *
2025f6ad3f23SAlexander Motin  * \param enc	SES enclosure the change is being applied to.
2026f6ad3f23SAlexander Motin  * \param buf	Buffer containing the current enclosure status response.
2027f6ad3f23SAlexander Motin  * \param amt	Length of the response in the buffer.
2028f6ad3f23SAlexander Motin  * \param req	The control request to be applied to buf.
2029f6ad3f23SAlexander Motin  *
2030f6ad3f23SAlexander Motin  * \return	0 on success, errno otherwise.
2031f6ad3f23SAlexander Motin  */
2032f6ad3f23SAlexander Motin static int
2033f6ad3f23SAlexander Motin ses_encode(enc_softc_t *enc, uint8_t *buf, int amt, ses_control_request_t *req)
2034f6ad3f23SAlexander Motin {
2035f6ad3f23SAlexander Motin 	struct ses_iterator iter;
2036f6ad3f23SAlexander Motin 	enc_element_t *element;
2037f6ad3f23SAlexander Motin 	int offset;
2038f6ad3f23SAlexander Motin 	struct ses_control_page_hdr *hdr;
2039f6ad3f23SAlexander Motin 
2040f6ad3f23SAlexander Motin 	ses_iter_init(enc, &enc->enc_cache, &iter);
2041f6ad3f23SAlexander Motin 	hdr = (struct ses_control_page_hdr *)buf;
2042f6ad3f23SAlexander Motin 	if (req->elm_idx == -1) {
2043f6ad3f23SAlexander Motin 		/* for enclosure status, at least 2 bytes are needed */
2044f6ad3f23SAlexander Motin 		if (amt < 2)
2045f6ad3f23SAlexander Motin 			return EIO;
2046f6ad3f23SAlexander Motin 		hdr->control_flags =
2047f6ad3f23SAlexander Motin 		    req->elm_stat.comstatus & SES_SET_STATUS_MASK;
2048f6ad3f23SAlexander Motin 		ENC_DLOG(enc, "Set EncStat %x\n", hdr->control_flags);
2049f6ad3f23SAlexander Motin 		return (0);
2050f6ad3f23SAlexander Motin 	}
2051f6ad3f23SAlexander Motin 
2052f6ad3f23SAlexander Motin 	element = ses_iter_seek_to(&iter, req->elm_idx, SES_ELEM_INDEX_GLOBAL);
2053f6ad3f23SAlexander Motin 	if (element == NULL)
2054f6ad3f23SAlexander Motin 		return (ENXIO);
2055f6ad3f23SAlexander Motin 
2056f6ad3f23SAlexander Motin 	/*
2057f6ad3f23SAlexander Motin 	 * Seek to the type set that corresponds to the requested object.
2058f6ad3f23SAlexander Motin 	 * The +1 is for the overall status element for the type.
2059f6ad3f23SAlexander Motin 	 */
2060f6ad3f23SAlexander Motin 	offset = sizeof(struct ses_control_page_hdr)
2061f6ad3f23SAlexander Motin 	       + (iter.global_element_index * sizeof(struct ses_comstat));
2062f6ad3f23SAlexander Motin 
2063f6ad3f23SAlexander Motin 	/* Check for buffer overflow. */
2064f6ad3f23SAlexander Motin 	if (offset + sizeof(struct ses_comstat) > amt)
2065f6ad3f23SAlexander Motin 		return (EIO);
2066f6ad3f23SAlexander Motin 
2067f6ad3f23SAlexander Motin 	/* Set the status. */
2068f6ad3f23SAlexander Motin 	memcpy(&buf[offset], &req->elm_stat, sizeof(struct ses_comstat));
2069f6ad3f23SAlexander Motin 
2070f6ad3f23SAlexander Motin 	ENC_DLOG(enc, "Set Type 0x%x Obj 0x%x (offset %d) with %x %x %x %x\n",
2071f6ad3f23SAlexander Motin 	    iter.type_index, iter.global_element_index, offset,
2072f6ad3f23SAlexander Motin 	    req->elm_stat.comstatus, req->elm_stat.comstat[0],
2073f6ad3f23SAlexander Motin 	    req->elm_stat.comstat[1], req->elm_stat.comstat[2]);
2074f6ad3f23SAlexander Motin 
2075f6ad3f23SAlexander Motin 	return (0);
2076f6ad3f23SAlexander Motin }
2077f6ad3f23SAlexander Motin 
2078f6ad3f23SAlexander Motin static int
2079f6ad3f23SAlexander Motin ses_fill_control_request(enc_softc_t *enc, struct enc_fsm_state *state,
2080f6ad3f23SAlexander Motin 			 union ccb *ccb, uint8_t *buf)
2081f6ad3f23SAlexander Motin {
2082f6ad3f23SAlexander Motin 	ses_softc_t			*ses;
2083f6ad3f23SAlexander Motin 	enc_cache_t			*enc_cache;
2084f6ad3f23SAlexander Motin 	ses_cache_t			*ses_cache;
2085f6ad3f23SAlexander Motin 	struct ses_control_page_hdr	*hdr;
2086f6ad3f23SAlexander Motin 	ses_control_request_t		*req;
2087f6ad3f23SAlexander Motin 	size_t				 plength;
2088f6ad3f23SAlexander Motin 	size_t				 offset;
2089f6ad3f23SAlexander Motin 
2090f6ad3f23SAlexander Motin 	ses = enc->enc_private;
2091f6ad3f23SAlexander Motin 	enc_cache = &enc->enc_daemon_cache;
2092f6ad3f23SAlexander Motin 	ses_cache = enc_cache->private;
2093f6ad3f23SAlexander Motin 	hdr = (struct ses_control_page_hdr *)buf;
2094f6ad3f23SAlexander Motin 
2095f6ad3f23SAlexander Motin 	if (ses_cache->status_page == NULL) {
2096f6ad3f23SAlexander Motin 		ses_terminate_control_requests(&ses->ses_requests, EIO);
2097f6ad3f23SAlexander Motin 		return (EIO);
2098f6ad3f23SAlexander Motin 	}
2099f6ad3f23SAlexander Motin 
2100f6ad3f23SAlexander Motin 	plength = ses_page_length(&ses_cache->status_page->hdr);
2101f6ad3f23SAlexander Motin 	memcpy(buf, ses_cache->status_page, plength);
2102f6ad3f23SAlexander Motin 
2103f6ad3f23SAlexander Motin 	/* Disable the select bits in all status entries.  */
2104f6ad3f23SAlexander Motin 	offset = sizeof(struct ses_control_page_hdr);
2105f6ad3f23SAlexander Motin 	for (offset = sizeof(struct ses_control_page_hdr);
2106f6ad3f23SAlexander Motin 	     offset < plength; offset += sizeof(struct ses_comstat)) {
2107f6ad3f23SAlexander Motin 		buf[offset] &= ~SESCTL_CSEL;
2108f6ad3f23SAlexander Motin 	}
2109f6ad3f23SAlexander Motin 
2110f6ad3f23SAlexander Motin 	/* And make sure the INVOP bit is clear.  */
2111f6ad3f23SAlexander Motin 	hdr->control_flags &= ~SES_ENCSTAT_INVOP;
2112f6ad3f23SAlexander Motin 
2113f6ad3f23SAlexander Motin 	/* Apply incoming requests. */
2114f6ad3f23SAlexander Motin 	while ((req = TAILQ_FIRST(&ses->ses_requests)) != NULL) {
2115f6ad3f23SAlexander Motin 
2116f6ad3f23SAlexander Motin 		TAILQ_REMOVE(&ses->ses_requests, req, links);
2117f6ad3f23SAlexander Motin 		req->result = ses_encode(enc, buf, plength, req);
2118f6ad3f23SAlexander Motin 		if (req->result != 0) {
2119f6ad3f23SAlexander Motin 			wakeup(req);
2120f6ad3f23SAlexander Motin 			continue;
2121f6ad3f23SAlexander Motin 		}
2122f6ad3f23SAlexander Motin 		TAILQ_INSERT_TAIL(&ses->ses_pending_requests, req, links);
2123f6ad3f23SAlexander Motin 	}
2124f6ad3f23SAlexander Motin 
2125f6ad3f23SAlexander Motin 	if (TAILQ_EMPTY(&ses->ses_pending_requests) != 0)
2126f6ad3f23SAlexander Motin 		return (ENOENT);
2127f6ad3f23SAlexander Motin 
2128f6ad3f23SAlexander Motin 	/* Fill out the ccb */
2129f6ad3f23SAlexander Motin 	if (enc->enc_type == ENC_SEMB_SES) {
2130f6ad3f23SAlexander Motin 		semb_send_diagnostic(&ccb->ataio, /*retries*/5, enc_done,
2131f6ad3f23SAlexander Motin 			     MSG_SIMPLE_Q_TAG,
2132f6ad3f23SAlexander Motin 			     buf, ses_page_length(&ses_cache->status_page->hdr),
2133f6ad3f23SAlexander Motin 			     state->timeout);
2134f6ad3f23SAlexander Motin 	} else {
2135f6ad3f23SAlexander Motin 		scsi_send_diagnostic(&ccb->csio, /*retries*/5, enc_done,
2136f6ad3f23SAlexander Motin 			     MSG_SIMPLE_Q_TAG, /*unit_offline*/0,
2137f6ad3f23SAlexander Motin 			     /*device_offline*/0, /*self_test*/0,
2138f6ad3f23SAlexander Motin 			     /*page_format*/1, /*self_test_code*/0,
2139f6ad3f23SAlexander Motin 			     buf, ses_page_length(&ses_cache->status_page->hdr),
2140f6ad3f23SAlexander Motin 			     SSD_FULL_SIZE, state->timeout);
2141f6ad3f23SAlexander Motin 	}
2142f6ad3f23SAlexander Motin 	return (0);
2143f6ad3f23SAlexander Motin }
2144f6ad3f23SAlexander Motin 
2145f6ad3f23SAlexander Motin static int
2146f6ad3f23SAlexander Motin ses_get_elm_addlstatus_fc(enc_softc_t *enc, enc_cache_t *enc_cache,
2147f6ad3f23SAlexander Motin 			  uint8_t *buf, int bufsiz)
2148f6ad3f23SAlexander Motin {
21495e6609a2SMatt Jacob 	ENC_VLOG(enc, "FC Device Support Stubbed in Additional Status Page\n");
2150f6ad3f23SAlexander Motin 	return (ENODEV);
2151f6ad3f23SAlexander Motin }
2152f6ad3f23SAlexander Motin 
2153f6ad3f23SAlexander Motin #define	SES_PRINT_PORTS(p, type) do {					\
2154f6ad3f23SAlexander Motin 	sbuf_printf(sbp, " %s(", type);					\
2155f6ad3f23SAlexander Motin 	if (((p) & SES_SASOBJ_DEV_PHY_PROTOMASK) == 0)			\
2156f6ad3f23SAlexander Motin 		sbuf_printf(sbp, " None");				\
2157f6ad3f23SAlexander Motin 	else {								\
2158f6ad3f23SAlexander Motin 		if ((p) & SES_SASOBJ_DEV_PHY_SMP)			\
2159f6ad3f23SAlexander Motin 			sbuf_printf(sbp, " SMP");			\
2160f6ad3f23SAlexander Motin 		if ((p) & SES_SASOBJ_DEV_PHY_STP)			\
2161f6ad3f23SAlexander Motin 			sbuf_printf(sbp, " STP");			\
2162f6ad3f23SAlexander Motin 		if ((p) & SES_SASOBJ_DEV_PHY_SSP)			\
2163f6ad3f23SAlexander Motin 			sbuf_printf(sbp, " SSP");			\
2164f6ad3f23SAlexander Motin 	}								\
2165f6ad3f23SAlexander Motin 	sbuf_printf(sbp, " )");						\
2166f6ad3f23SAlexander Motin } while(0)
2167f6ad3f23SAlexander Motin 
2168f6ad3f23SAlexander Motin /**
2169f6ad3f23SAlexander Motin  * \brief Print the additional element status data for this object, for SAS
2170f6ad3f23SAlexander Motin  * 	  type 0 objects.  See SES2 r20 Section 6.1.13.3.2.
2171f6ad3f23SAlexander Motin  *
2172f6ad3f23SAlexander Motin  * \param sesname	SES device name associated with the object.
2173f6ad3f23SAlexander Motin  * \param sbp		Sbuf to print to.
2174f6ad3f23SAlexander Motin  * \param obj		The object to print the data for.
2175f6ad3f23SAlexander Motin  * \param periph_name	Peripheral string associated with the object.
2176f6ad3f23SAlexander Motin  */
2177f6ad3f23SAlexander Motin static void
2178f6ad3f23SAlexander Motin ses_print_addl_data_sas_type0(char *sesname, struct sbuf *sbp,
2179f6ad3f23SAlexander Motin 			      enc_element_t *obj, char *periph_name)
2180f6ad3f23SAlexander Motin {
2181f6ad3f23SAlexander Motin 	int i;
2182f6ad3f23SAlexander Motin 	ses_element_t *elmpriv;
2183f6ad3f23SAlexander Motin 	struct ses_addl_status *addl;
2184f6ad3f23SAlexander Motin 	struct ses_elm_sas_device_phy *phy;
2185f6ad3f23SAlexander Motin 
2186f6ad3f23SAlexander Motin 	elmpriv = obj->elm_private;
2187f6ad3f23SAlexander Motin 	addl = &(elmpriv->addl);
2188f6ad3f23SAlexander Motin 	if (addl->proto_hdr.sas == NULL)
2189f6ad3f23SAlexander Motin 		return;
2190f6ad3f23SAlexander Motin 	sbuf_printf(sbp, "%s: %s: SAS Device Slot Element:",
2191f6ad3f23SAlexander Motin 	    sesname, periph_name);
2192f6ad3f23SAlexander Motin 	sbuf_printf(sbp, " %d Phys", addl->proto_hdr.sas->base_hdr.num_phys);
2193f6ad3f23SAlexander Motin 	if (ses_elm_addlstatus_eip(addl->hdr))
2194f6ad3f23SAlexander Motin 		sbuf_printf(sbp, " at Slot %d",
2195f6ad3f23SAlexander Motin 		    addl->proto_hdr.sas->type0_eip.dev_slot_num);
2196f6ad3f23SAlexander Motin 	if (ses_elm_sas_type0_not_all_phys(addl->proto_hdr.sas))
2197f6ad3f23SAlexander Motin 		sbuf_printf(sbp, ", Not All Phys");
2198f6ad3f23SAlexander Motin 	sbuf_printf(sbp, "\n");
2199f6ad3f23SAlexander Motin 	if (addl->proto_data.sasdev_phys == NULL)
2200f6ad3f23SAlexander Motin 		return;
2201f6ad3f23SAlexander Motin 	for (i = 0;i < addl->proto_hdr.sas->base_hdr.num_phys;i++) {
2202f6ad3f23SAlexander Motin 		phy = &addl->proto_data.sasdev_phys[i];
2203f6ad3f23SAlexander Motin 		sbuf_printf(sbp, "%s:  phy %d:", sesname, i);
2204f6ad3f23SAlexander Motin 		if (ses_elm_sas_dev_phy_sata_dev(phy))
2205f6ad3f23SAlexander Motin 			/* Spec says all other fields are specific values */
2206f6ad3f23SAlexander Motin 			sbuf_printf(sbp, " SATA device\n");
2207f6ad3f23SAlexander Motin 		else {
2208f6ad3f23SAlexander Motin 			sbuf_printf(sbp, " SAS device type %d id %d\n",
2209f6ad3f23SAlexander Motin 			    ses_elm_sas_dev_phy_dev_type(phy), phy->phy_id);
2210f6ad3f23SAlexander Motin 			sbuf_printf(sbp, "%s:  phy %d: protocols:", sesname, i);
2211f6ad3f23SAlexander Motin 			SES_PRINT_PORTS(phy->initiator_ports, "Initiator");
2212f6ad3f23SAlexander Motin 			SES_PRINT_PORTS(phy->target_ports, "Target");
2213f6ad3f23SAlexander Motin 			sbuf_printf(sbp, "\n");
2214f6ad3f23SAlexander Motin 		}
2215f6ad3f23SAlexander Motin 		sbuf_printf(sbp, "%s:  phy %d: parent %jx addr %jx\n",
2216f6ad3f23SAlexander Motin 		    sesname, i,
2217f6ad3f23SAlexander Motin 		    (uintmax_t)scsi_8btou64(phy->parent_addr),
2218f6ad3f23SAlexander Motin 		    (uintmax_t)scsi_8btou64(phy->phy_addr));
2219f6ad3f23SAlexander Motin 	}
2220f6ad3f23SAlexander Motin }
2221f6ad3f23SAlexander Motin #undef SES_PRINT_PORTS
2222f6ad3f23SAlexander Motin 
2223f6ad3f23SAlexander Motin /**
2224f6ad3f23SAlexander Motin  * \brief Report whether a given enclosure object is an expander.
2225f6ad3f23SAlexander Motin  *
2226f6ad3f23SAlexander Motin  * \param enc	SES softc associated with object.
2227f6ad3f23SAlexander Motin  * \param obj	Enclosure object to report for.
2228f6ad3f23SAlexander Motin  *
2229f6ad3f23SAlexander Motin  * \return	1 if true, 0 otherwise.
2230f6ad3f23SAlexander Motin  */
2231f6ad3f23SAlexander Motin static int
2232f6ad3f23SAlexander Motin ses_obj_is_expander(enc_softc_t *enc, enc_element_t *obj)
2233f6ad3f23SAlexander Motin {
2234f6ad3f23SAlexander Motin 	return (obj->enctype == ELMTYP_SAS_EXP);
2235f6ad3f23SAlexander Motin }
2236f6ad3f23SAlexander Motin 
2237f6ad3f23SAlexander Motin /**
2238f6ad3f23SAlexander Motin  * \brief Print the additional element status data for this object, for SAS
2239f6ad3f23SAlexander Motin  *	  type 1 objects.  See SES2 r20 Sections 6.1.13.3.3 and 6.1.13.3.4.
2240f6ad3f23SAlexander Motin  *
2241f6ad3f23SAlexander Motin  * \param enc		SES enclosure, needed for type identification.
2242f6ad3f23SAlexander Motin  * \param sesname	SES device name associated with the object.
2243f6ad3f23SAlexander Motin  * \param sbp		Sbuf to print to.
2244f6ad3f23SAlexander Motin  * \param obj		The object to print the data for.
2245f6ad3f23SAlexander Motin  * \param periph_name	Peripheral string associated with the object.
2246f6ad3f23SAlexander Motin  */
2247f6ad3f23SAlexander Motin static void
2248f6ad3f23SAlexander Motin ses_print_addl_data_sas_type1(enc_softc_t *enc, char *sesname,
2249f6ad3f23SAlexander Motin     struct sbuf *sbp, enc_element_t *obj, char *periph_name)
2250f6ad3f23SAlexander Motin {
2251f6ad3f23SAlexander Motin 	int i, num_phys;
2252f6ad3f23SAlexander Motin 	ses_element_t *elmpriv;
2253f6ad3f23SAlexander Motin 	struct ses_addl_status *addl;
2254f6ad3f23SAlexander Motin 	struct ses_elm_sas_expander_phy *exp_phy;
2255f6ad3f23SAlexander Motin 	struct ses_elm_sas_port_phy *port_phy;
2256f6ad3f23SAlexander Motin 
2257f6ad3f23SAlexander Motin 	elmpriv = obj->elm_private;
2258f6ad3f23SAlexander Motin 	addl = &(elmpriv->addl);
2259f6ad3f23SAlexander Motin 	if (addl->proto_hdr.sas == NULL)
2260f6ad3f23SAlexander Motin 		return;
2261f6ad3f23SAlexander Motin 	sbuf_printf(sbp, "%s: %s: SAS ", sesname, periph_name);
2262f6ad3f23SAlexander Motin 	if (ses_obj_is_expander(enc, obj)) {
2263f6ad3f23SAlexander Motin 		num_phys = addl->proto_hdr.sas->base_hdr.num_phys;
2264f6ad3f23SAlexander Motin 		sbuf_printf(sbp, "Expander: %d Phys", num_phys);
2265f6ad3f23SAlexander Motin 		if (addl->proto_data.sasexp_phys == NULL)
2266f6ad3f23SAlexander Motin 			return;
2267f6ad3f23SAlexander Motin 		for (i = 0;i < num_phys;i++) {
2268f6ad3f23SAlexander Motin 			exp_phy = &addl->proto_data.sasexp_phys[i];
2269f6ad3f23SAlexander Motin 			sbuf_printf(sbp, "%s:  phy %d: connector %d other %d\n",
2270f6ad3f23SAlexander Motin 			    sesname, i, exp_phy->connector_index,
2271f6ad3f23SAlexander Motin 			    exp_phy->other_index);
2272f6ad3f23SAlexander Motin 		}
2273f6ad3f23SAlexander Motin 	} else {
2274f6ad3f23SAlexander Motin 		num_phys = addl->proto_hdr.sas->base_hdr.num_phys;
2275f6ad3f23SAlexander Motin 		sbuf_printf(sbp, "Port: %d Phys", num_phys);
2276f6ad3f23SAlexander Motin 		if (addl->proto_data.sasport_phys == NULL)
2277f6ad3f23SAlexander Motin 			return;
2278f6ad3f23SAlexander Motin 		for (i = 0;i < num_phys;i++) {
2279f6ad3f23SAlexander Motin 			port_phy = &addl->proto_data.sasport_phys[i];
2280f6ad3f23SAlexander Motin 			sbuf_printf(sbp,
2281f6ad3f23SAlexander Motin 			    "%s:  phy %d: id %d connector %d other %d\n",
2282f6ad3f23SAlexander Motin 			    sesname, i, port_phy->phy_id,
2283f6ad3f23SAlexander Motin 			    port_phy->connector_index, port_phy->other_index);
2284f6ad3f23SAlexander Motin 			sbuf_printf(sbp, "%s:  phy %d: addr %jx\n", sesname, i,
2285f6ad3f23SAlexander Motin 			    (uintmax_t)scsi_8btou64(port_phy->phy_addr));
2286f6ad3f23SAlexander Motin 		}
2287f6ad3f23SAlexander Motin 	}
2288f6ad3f23SAlexander Motin }
2289f6ad3f23SAlexander Motin 
2290f6ad3f23SAlexander Motin /**
2291f6ad3f23SAlexander Motin  * \brief Print the additional element status data for this object.
2292f6ad3f23SAlexander Motin  *
2293f6ad3f23SAlexander Motin  * \param enc		SES softc associated with the object.
2294f6ad3f23SAlexander Motin  * \param obj		The object to print the data for.
2295f6ad3f23SAlexander Motin  */
2296f6ad3f23SAlexander Motin static void
2297f6ad3f23SAlexander Motin ses_print_addl_data(enc_softc_t *enc, enc_element_t *obj)
2298f6ad3f23SAlexander Motin {
2299f6ad3f23SAlexander Motin 	ses_element_t *elmpriv;
2300f6ad3f23SAlexander Motin 	struct ses_addl_status *addl;
2301f6ad3f23SAlexander Motin 	struct sbuf sesname, name, out;
2302f6ad3f23SAlexander Motin 
2303f6ad3f23SAlexander Motin 	elmpriv = obj->elm_private;
2304f6ad3f23SAlexander Motin 	if (elmpriv == NULL)
2305f6ad3f23SAlexander Motin 		return;
2306f6ad3f23SAlexander Motin 
2307f6ad3f23SAlexander Motin 	addl = &(elmpriv->addl);
2308f6ad3f23SAlexander Motin 	if (addl->hdr == NULL)
2309f6ad3f23SAlexander Motin 		return;
2310f6ad3f23SAlexander Motin 
2311f6ad3f23SAlexander Motin 	sbuf_new(&sesname, NULL, 16, SBUF_AUTOEXTEND);
2312f6ad3f23SAlexander Motin 	sbuf_new(&name, NULL, 16, SBUF_AUTOEXTEND);
2313f6ad3f23SAlexander Motin 	sbuf_new(&out, NULL, 512, SBUF_AUTOEXTEND);
2314f6ad3f23SAlexander Motin 	ses_paths_iter(enc, obj, ses_elmdevname_callback, &name);
2315f6ad3f23SAlexander Motin 	if (sbuf_len(&name) == 0)
2316f6ad3f23SAlexander Motin 		sbuf_printf(&name, "(none)");
2317f6ad3f23SAlexander Motin 	sbuf_finish(&name);
2318f6ad3f23SAlexander Motin 	sbuf_printf(&sesname, "%s%d", enc->periph->periph_name,
2319f6ad3f23SAlexander Motin 	    enc->periph->unit_number);
2320f6ad3f23SAlexander Motin 	sbuf_finish(&sesname);
2321f6ad3f23SAlexander Motin 	if (elmpriv->descr != NULL)
2322f6ad3f23SAlexander Motin 		sbuf_printf(&out, "%s: %s: Element descriptor: '%s'\n",
2323f6ad3f23SAlexander Motin 		    sbuf_data(&sesname), sbuf_data(&name), elmpriv->descr);
2324f6ad3f23SAlexander Motin 	switch(ses_elm_addlstatus_proto(addl->hdr)) {
2325f6ad3f23SAlexander Motin 	case SPSP_PROTO_SAS:
2326f6ad3f23SAlexander Motin 		switch(ses_elm_sas_descr_type(addl->proto_hdr.sas)) {
2327f6ad3f23SAlexander Motin 		case SES_SASOBJ_TYPE_SLOT:
2328f6ad3f23SAlexander Motin 			ses_print_addl_data_sas_type0(sbuf_data(&sesname),
2329f6ad3f23SAlexander Motin 			    &out, obj, sbuf_data(&name));
2330f6ad3f23SAlexander Motin 			break;
2331f6ad3f23SAlexander Motin 		case SES_SASOBJ_TYPE_OTHER:
2332f6ad3f23SAlexander Motin 			ses_print_addl_data_sas_type1(enc, sbuf_data(&sesname),
2333f6ad3f23SAlexander Motin 			    &out, obj, sbuf_data(&name));
2334f6ad3f23SAlexander Motin 			break;
2335f6ad3f23SAlexander Motin 		default:
2336f6ad3f23SAlexander Motin 			break;
2337f6ad3f23SAlexander Motin 		}
2338f6ad3f23SAlexander Motin 		break;
2339f6ad3f23SAlexander Motin 	case SPSP_PROTO_FC:	/* stubbed for now */
2340f6ad3f23SAlexander Motin 		break;
2341f6ad3f23SAlexander Motin 	default:
2342f6ad3f23SAlexander Motin 		break;
2343f6ad3f23SAlexander Motin 	}
2344f6ad3f23SAlexander Motin 	sbuf_finish(&out);
2345f6ad3f23SAlexander Motin 	printf("%s", sbuf_data(&out));
2346f6ad3f23SAlexander Motin 	sbuf_delete(&out);
2347f6ad3f23SAlexander Motin 	sbuf_delete(&name);
2348f6ad3f23SAlexander Motin 	sbuf_delete(&sesname);
2349f6ad3f23SAlexander Motin }
2350f6ad3f23SAlexander Motin 
2351f6ad3f23SAlexander Motin /**
2352f6ad3f23SAlexander Motin  * \brief Update the softc with the additional element status data for this
2353f6ad3f23SAlexander Motin  * 	  object, for SAS type 0 objects.
2354f6ad3f23SAlexander Motin  *
2355f6ad3f23SAlexander Motin  * \param enc		SES softc to be updated.
2356f6ad3f23SAlexander Motin  * \param buf		The additional element status response buffer.
2357f6ad3f23SAlexander Motin  * \param bufsiz	Size of the response buffer.
2358f6ad3f23SAlexander Motin  * \param eip		The EIP bit value.
2359f6ad3f23SAlexander Motin  * \param nobj		Number of objects attached to the SES softc.
2360f6ad3f23SAlexander Motin  *
2361f6ad3f23SAlexander Motin  * \return		0 on success, errno otherwise.
2362f6ad3f23SAlexander Motin  */
2363f6ad3f23SAlexander Motin static int
2364f6ad3f23SAlexander Motin ses_get_elm_addlstatus_sas_type0(enc_softc_t *enc, enc_cache_t *enc_cache,
2365f6ad3f23SAlexander Motin 				 uint8_t *buf, int bufsiz, int eip, int nobj)
2366f6ad3f23SAlexander Motin {
2367f6ad3f23SAlexander Motin 	int err, offset, physz;
2368f6ad3f23SAlexander Motin 	enc_element_t *obj;
2369f6ad3f23SAlexander Motin 	ses_element_t *elmpriv;
2370f6ad3f23SAlexander Motin 	struct ses_addl_status *addl;
2371f6ad3f23SAlexander Motin 
2372f6ad3f23SAlexander Motin 	err = offset = 0;
2373f6ad3f23SAlexander Motin 
2374f6ad3f23SAlexander Motin 	/* basic object setup */
2375f6ad3f23SAlexander Motin 	obj = &(enc_cache->elm_map[nobj]);
2376f6ad3f23SAlexander Motin 	elmpriv = obj->elm_private;
2377f6ad3f23SAlexander Motin 	addl = &(elmpriv->addl);
2378f6ad3f23SAlexander Motin 
2379f6ad3f23SAlexander Motin 	addl->proto_hdr.sas = (union ses_elm_sas_hdr *)&buf[offset];
2380f6ad3f23SAlexander Motin 
2381f6ad3f23SAlexander Motin 	/* Don't assume this object has any phys */
2382f6ad3f23SAlexander Motin 	bzero(&addl->proto_data, sizeof(addl->proto_data));
2383f6ad3f23SAlexander Motin 	if (addl->proto_hdr.sas->base_hdr.num_phys == 0)
2384f6ad3f23SAlexander Motin 		goto out;
2385f6ad3f23SAlexander Motin 
2386f6ad3f23SAlexander Motin 	/* Skip forward to the phy list */
2387f6ad3f23SAlexander Motin 	if (eip)
2388f6ad3f23SAlexander Motin 		offset += sizeof(struct ses_elm_sas_type0_eip_hdr);
2389f6ad3f23SAlexander Motin 	else
2390f6ad3f23SAlexander Motin 		offset += sizeof(struct ses_elm_sas_type0_base_hdr);
2391f6ad3f23SAlexander Motin 
2392f6ad3f23SAlexander Motin 	/* Make sure the phy list fits in the buffer */
2393f6ad3f23SAlexander Motin 	physz = addl->proto_hdr.sas->base_hdr.num_phys;
2394f6ad3f23SAlexander Motin 	physz *= sizeof(struct ses_elm_sas_device_phy);
2395f6ad3f23SAlexander Motin 	if (physz > (bufsiz - offset + 4)) {
23965e6609a2SMatt Jacob 		ENC_VLOG(enc, "Element %d Device Phy List Beyond End Of Buffer\n",
2397f6ad3f23SAlexander Motin 		    nobj);
2398f6ad3f23SAlexander Motin 		err = EIO;
2399f6ad3f23SAlexander Motin 		goto out;
2400f6ad3f23SAlexander Motin 	}
2401f6ad3f23SAlexander Motin 
2402f6ad3f23SAlexander Motin 	/* Point to the phy list */
2403f6ad3f23SAlexander Motin 	addl->proto_data.sasdev_phys =
2404f6ad3f23SAlexander Motin 	    (struct ses_elm_sas_device_phy *)&buf[offset];
2405f6ad3f23SAlexander Motin 
2406f6ad3f23SAlexander Motin out:
2407f6ad3f23SAlexander Motin 	return (err);
2408f6ad3f23SAlexander Motin }
2409f6ad3f23SAlexander Motin 
2410f6ad3f23SAlexander Motin /**
2411f6ad3f23SAlexander Motin  * \brief Update the softc with the additional element status data for this
2412f6ad3f23SAlexander Motin  * 	  object, for SAS type 1 objects.
2413f6ad3f23SAlexander Motin  *
2414f6ad3f23SAlexander Motin  * \param enc		SES softc to be updated.
2415f6ad3f23SAlexander Motin  * \param buf		The additional element status response buffer.
2416f6ad3f23SAlexander Motin  * \param bufsiz	Size of the response buffer.
2417f6ad3f23SAlexander Motin  * \param eip		The EIP bit value.
2418f6ad3f23SAlexander Motin  * \param nobj		Number of objects attached to the SES softc.
2419f6ad3f23SAlexander Motin  *
2420f6ad3f23SAlexander Motin  * \return		0 on success, errno otherwise.
2421f6ad3f23SAlexander Motin  */
2422f6ad3f23SAlexander Motin static int
2423f6ad3f23SAlexander Motin ses_get_elm_addlstatus_sas_type1(enc_softc_t *enc, enc_cache_t *enc_cache,
2424f6ad3f23SAlexander Motin 			         uint8_t *buf, int bufsiz, int eip, int nobj)
2425f6ad3f23SAlexander Motin {
2426f6ad3f23SAlexander Motin 	int err, offset, physz;
2427f6ad3f23SAlexander Motin 	enc_element_t *obj;
2428f6ad3f23SAlexander Motin 	ses_element_t *elmpriv;
2429f6ad3f23SAlexander Motin 	struct ses_addl_status *addl;
2430f6ad3f23SAlexander Motin 
2431f6ad3f23SAlexander Motin 	err = offset = 0;
2432f6ad3f23SAlexander Motin 
2433f6ad3f23SAlexander Motin 	/* basic object setup */
2434f6ad3f23SAlexander Motin 	obj = &(enc_cache->elm_map[nobj]);
2435f6ad3f23SAlexander Motin 	elmpriv = obj->elm_private;
2436f6ad3f23SAlexander Motin 	addl = &(elmpriv->addl);
2437f6ad3f23SAlexander Motin 
2438f6ad3f23SAlexander Motin 	addl->proto_hdr.sas = (union ses_elm_sas_hdr *)&buf[offset];
2439f6ad3f23SAlexander Motin 
2440f6ad3f23SAlexander Motin 	/* Don't assume this object has any phys */
2441f6ad3f23SAlexander Motin 	bzero(&addl->proto_data, sizeof(addl->proto_data));
2442f6ad3f23SAlexander Motin 	if (addl->proto_hdr.sas->base_hdr.num_phys == 0)
2443f6ad3f23SAlexander Motin 		goto out;
2444f6ad3f23SAlexander Motin 
2445f6ad3f23SAlexander Motin 	/* Process expanders differently from other type1 cases */
2446f6ad3f23SAlexander Motin 	if (ses_obj_is_expander(enc, obj)) {
2447f6ad3f23SAlexander Motin 		offset += sizeof(struct ses_elm_sas_type1_expander_hdr);
2448f6ad3f23SAlexander Motin 		physz = addl->proto_hdr.sas->base_hdr.num_phys *
2449f6ad3f23SAlexander Motin 		    sizeof(struct ses_elm_sas_expander_phy);
2450f6ad3f23SAlexander Motin 		if (physz > (bufsiz - offset)) {
24515e6609a2SMatt Jacob 			ENC_VLOG(enc, "Element %d: Expander Phy List Beyond "
2452f6ad3f23SAlexander Motin 			    "End Of Buffer\n", nobj);
2453f6ad3f23SAlexander Motin 			err = EIO;
2454f6ad3f23SAlexander Motin 			goto out;
2455f6ad3f23SAlexander Motin 		}
2456f6ad3f23SAlexander Motin 		addl->proto_data.sasexp_phys =
2457f6ad3f23SAlexander Motin 		    (struct ses_elm_sas_expander_phy *)&buf[offset];
2458f6ad3f23SAlexander Motin 	} else {
2459f6ad3f23SAlexander Motin 		offset += sizeof(struct ses_elm_sas_type1_nonexpander_hdr);
2460f6ad3f23SAlexander Motin 		physz = addl->proto_hdr.sas->base_hdr.num_phys *
2461f6ad3f23SAlexander Motin 		    sizeof(struct ses_elm_sas_port_phy);
2462f6ad3f23SAlexander Motin 		if (physz > (bufsiz - offset + 4)) {
24635e6609a2SMatt Jacob 			ENC_VLOG(enc, "Element %d: Port Phy List Beyond End "
2464f6ad3f23SAlexander Motin 			    "Of Buffer\n", nobj);
2465f6ad3f23SAlexander Motin 			err = EIO;
2466f6ad3f23SAlexander Motin 			goto out;
2467f6ad3f23SAlexander Motin 		}
2468f6ad3f23SAlexander Motin 		addl->proto_data.sasport_phys =
2469f6ad3f23SAlexander Motin 		    (struct ses_elm_sas_port_phy *)&buf[offset];
2470f6ad3f23SAlexander Motin 	}
2471f6ad3f23SAlexander Motin 
2472f6ad3f23SAlexander Motin out:
2473f6ad3f23SAlexander Motin 	return (err);
2474f6ad3f23SAlexander Motin }
2475f6ad3f23SAlexander Motin 
2476f6ad3f23SAlexander Motin /**
2477f6ad3f23SAlexander Motin  * \brief Update the softc with the additional element status data for this
2478f6ad3f23SAlexander Motin  * 	  object, for SAS objects.
2479f6ad3f23SAlexander Motin  *
2480f6ad3f23SAlexander Motin  * \param enc		SES softc to be updated.
2481f6ad3f23SAlexander Motin  * \param buf		The additional element status response buffer.
2482f6ad3f23SAlexander Motin  * \param bufsiz	Size of the response buffer.
2483f6ad3f23SAlexander Motin  * \param eip		The EIP bit value.
2484f6ad3f23SAlexander Motin  * \param tidx		Type index for this object.
2485f6ad3f23SAlexander Motin  * \param nobj		Number of objects attached to the SES softc.
2486f6ad3f23SAlexander Motin  *
2487f6ad3f23SAlexander Motin  * \return		0 on success, errno otherwise.
2488f6ad3f23SAlexander Motin  */
2489f6ad3f23SAlexander Motin static int
2490f6ad3f23SAlexander Motin ses_get_elm_addlstatus_sas(enc_softc_t *enc, enc_cache_t *enc_cache,
2491f6ad3f23SAlexander Motin 			   uint8_t *buf, int bufsiz, int eip, int tidx,
2492f6ad3f23SAlexander Motin 			   int nobj)
2493f6ad3f23SAlexander Motin {
2494f6ad3f23SAlexander Motin 	int dtype, err;
2495f6ad3f23SAlexander Motin 	ses_cache_t *ses_cache;
2496f6ad3f23SAlexander Motin 	union ses_elm_sas_hdr *hdr;
2497f6ad3f23SAlexander Motin 
2498f6ad3f23SAlexander Motin 	/* Need to be able to read the descriptor type! */
2499f6ad3f23SAlexander Motin 	if (bufsiz < sizeof(union ses_elm_sas_hdr)) {
2500f6ad3f23SAlexander Motin 		err = EIO;
2501f6ad3f23SAlexander Motin 		goto out;
2502f6ad3f23SAlexander Motin 	}
2503f6ad3f23SAlexander Motin 
2504f6ad3f23SAlexander Motin 	ses_cache = enc_cache->private;
2505f6ad3f23SAlexander Motin 
2506f6ad3f23SAlexander Motin 	hdr = (union ses_elm_sas_hdr *)buf;
2507f6ad3f23SAlexander Motin 	dtype = ses_elm_sas_descr_type(hdr);
2508f6ad3f23SAlexander Motin 	switch(dtype) {
2509f6ad3f23SAlexander Motin 	case SES_SASOBJ_TYPE_SLOT:
2510f6ad3f23SAlexander Motin 		switch(ses_cache->ses_types[tidx].hdr->etype_elm_type) {
2511f6ad3f23SAlexander Motin 		case ELMTYP_DEVICE:
2512f6ad3f23SAlexander Motin 		case ELMTYP_ARRAY_DEV:
2513f6ad3f23SAlexander Motin 			break;
2514f6ad3f23SAlexander Motin 		default:
25155e6609a2SMatt Jacob 			ENC_VLOG(enc, "Element %d has Additional Status type 0, "
2516f6ad3f23SAlexander Motin 			    "invalid for SES element type 0x%x\n", nobj,
2517f6ad3f23SAlexander Motin 			    ses_cache->ses_types[tidx].hdr->etype_elm_type);
2518f6ad3f23SAlexander Motin 			err = ENODEV;
2519f6ad3f23SAlexander Motin 			goto out;
2520f6ad3f23SAlexander Motin 		}
2521f6ad3f23SAlexander Motin 		err = ses_get_elm_addlstatus_sas_type0(enc, enc_cache,
2522f6ad3f23SAlexander Motin 						       buf, bufsiz, eip,
2523f6ad3f23SAlexander Motin 		    nobj);
2524f6ad3f23SAlexander Motin 		break;
2525f6ad3f23SAlexander Motin 	case SES_SASOBJ_TYPE_OTHER:
2526f6ad3f23SAlexander Motin 		switch(ses_cache->ses_types[tidx].hdr->etype_elm_type) {
2527f6ad3f23SAlexander Motin 		case ELMTYP_SAS_EXP:
2528f6ad3f23SAlexander Motin 		case ELMTYP_SCSI_INI:
2529f6ad3f23SAlexander Motin 		case ELMTYP_SCSI_TGT:
2530f6ad3f23SAlexander Motin 		case ELMTYP_ESCC:
2531f6ad3f23SAlexander Motin 			break;
2532f6ad3f23SAlexander Motin 		default:
25335e6609a2SMatt Jacob 			ENC_VLOG(enc, "Element %d has Additional Status type 1, "
2534f6ad3f23SAlexander Motin 			    "invalid for SES element type 0x%x\n", nobj,
2535f6ad3f23SAlexander Motin 			    ses_cache->ses_types[tidx].hdr->etype_elm_type);
2536f6ad3f23SAlexander Motin 			err = ENODEV;
2537f6ad3f23SAlexander Motin 			goto out;
2538f6ad3f23SAlexander Motin 		}
2539f6ad3f23SAlexander Motin 		err = ses_get_elm_addlstatus_sas_type1(enc, enc_cache, buf,
2540f6ad3f23SAlexander Motin 						       bufsiz, eip, nobj);
2541f6ad3f23SAlexander Motin 		break;
2542f6ad3f23SAlexander Motin 	default:
25435e6609a2SMatt Jacob 		ENC_VLOG(enc, "Element %d of type 0x%x has Additional Status "
2544f6ad3f23SAlexander Motin 		    "of unknown type 0x%x\n", nobj,
2545f6ad3f23SAlexander Motin 		    ses_cache->ses_types[tidx].hdr->etype_elm_type, dtype);
2546f6ad3f23SAlexander Motin 		err = ENODEV;
2547f6ad3f23SAlexander Motin 		break;
2548f6ad3f23SAlexander Motin 	}
2549f6ad3f23SAlexander Motin 
2550f6ad3f23SAlexander Motin out:
2551f6ad3f23SAlexander Motin 	return (err);
2552f6ad3f23SAlexander Motin }
2553f6ad3f23SAlexander Motin 
2554f6ad3f23SAlexander Motin static void
2555f6ad3f23SAlexander Motin ses_softc_invalidate(enc_softc_t *enc)
2556f6ad3f23SAlexander Motin {
2557f6ad3f23SAlexander Motin 	ses_softc_t *ses;
2558f6ad3f23SAlexander Motin 
2559f6ad3f23SAlexander Motin 	ses = enc->enc_private;
2560f6ad3f23SAlexander Motin 	ses_terminate_control_requests(&ses->ses_requests, ENXIO);
2561f6ad3f23SAlexander Motin }
2562f6ad3f23SAlexander Motin 
2563f6ad3f23SAlexander Motin static void
2564f6ad3f23SAlexander Motin ses_softc_cleanup(enc_softc_t *enc)
2565f6ad3f23SAlexander Motin {
2566f6ad3f23SAlexander Motin 
2567f6ad3f23SAlexander Motin 	ses_cache_free(enc, &enc->enc_cache);
2568f6ad3f23SAlexander Motin 	ses_cache_free(enc, &enc->enc_daemon_cache);
2569f6ad3f23SAlexander Motin 	ENC_FREE_AND_NULL(enc->enc_private);
2570f6ad3f23SAlexander Motin 	ENC_FREE_AND_NULL(enc->enc_cache.private);
2571f6ad3f23SAlexander Motin 	ENC_FREE_AND_NULL(enc->enc_daemon_cache.private);
2572f6ad3f23SAlexander Motin }
2573f6ad3f23SAlexander Motin 
2574f6ad3f23SAlexander Motin static int
2575f6ad3f23SAlexander Motin ses_init_enc(enc_softc_t *enc)
2576f6ad3f23SAlexander Motin {
2577f6ad3f23SAlexander Motin 	return (0);
2578f6ad3f23SAlexander Motin }
2579f6ad3f23SAlexander Motin 
2580f6ad3f23SAlexander Motin static int
2581f6ad3f23SAlexander Motin ses_get_enc_status(enc_softc_t *enc, int slpflag)
2582f6ad3f23SAlexander Motin {
2583f6ad3f23SAlexander Motin 	/* Automatically updated, caller checks enc_cache->encstat itself */
2584f6ad3f23SAlexander Motin 	return (0);
2585f6ad3f23SAlexander Motin }
2586f6ad3f23SAlexander Motin 
2587f6ad3f23SAlexander Motin static int
2588f6ad3f23SAlexander Motin ses_set_enc_status(enc_softc_t *enc, uint8_t encstat, int slpflag)
2589f6ad3f23SAlexander Motin {
2590f6ad3f23SAlexander Motin 	ses_control_request_t req;
2591f6ad3f23SAlexander Motin 	ses_softc_t	     *ses;
2592f6ad3f23SAlexander Motin 
2593f6ad3f23SAlexander Motin 	ses = enc->enc_private;
2594f6ad3f23SAlexander Motin 	req.elm_idx = SES_SETSTATUS_ENC_IDX;
2595f6ad3f23SAlexander Motin 	req.elm_stat.comstatus = encstat & 0xf;
2596f6ad3f23SAlexander Motin 
2597f6ad3f23SAlexander Motin 	TAILQ_INSERT_TAIL(&ses->ses_requests, &req, links);
2598f6ad3f23SAlexander Motin 	enc_update_request(enc, SES_PROCESS_CONTROL_REQS);
2599f6ad3f23SAlexander Motin 	cam_periph_sleep(enc->periph, &req, PUSER, "encstat", 0);
2600f6ad3f23SAlexander Motin 
2601f6ad3f23SAlexander Motin 	return (req.result);
2602f6ad3f23SAlexander Motin }
2603f6ad3f23SAlexander Motin 
2604f6ad3f23SAlexander Motin static int
2605f6ad3f23SAlexander Motin ses_get_elm_status(enc_softc_t *enc, encioc_elm_status_t *elms, int slpflag)
2606f6ad3f23SAlexander Motin {
2607f6ad3f23SAlexander Motin 	unsigned int i = elms->elm_idx;
2608f6ad3f23SAlexander Motin 
2609f6ad3f23SAlexander Motin 	memcpy(elms->cstat, &enc->enc_cache.elm_map[i].encstat, 4);
2610f6ad3f23SAlexander Motin 	return (0);
2611f6ad3f23SAlexander Motin }
2612f6ad3f23SAlexander Motin 
2613f6ad3f23SAlexander Motin static int
2614f6ad3f23SAlexander Motin ses_set_elm_status(enc_softc_t *enc, encioc_elm_status_t *elms, int slpflag)
2615f6ad3f23SAlexander Motin {
2616f6ad3f23SAlexander Motin 	ses_control_request_t req;
2617f6ad3f23SAlexander Motin 	ses_softc_t	     *ses;
2618f6ad3f23SAlexander Motin 
2619f6ad3f23SAlexander Motin 	/* If this is clear, we don't do diddly.  */
2620f6ad3f23SAlexander Motin 	if ((elms->cstat[0] & SESCTL_CSEL) == 0)
2621f6ad3f23SAlexander Motin 		return (0);
2622f6ad3f23SAlexander Motin 
2623f6ad3f23SAlexander Motin 	ses = enc->enc_private;
2624f6ad3f23SAlexander Motin 	req.elm_idx = elms->elm_idx;
2625f6ad3f23SAlexander Motin 	memcpy(&req.elm_stat, elms->cstat, sizeof(req.elm_stat));
2626f6ad3f23SAlexander Motin 
2627f6ad3f23SAlexander Motin 	TAILQ_INSERT_TAIL(&ses->ses_requests, &req, links);
2628f6ad3f23SAlexander Motin 	enc_update_request(enc, SES_PROCESS_CONTROL_REQS);
2629f6ad3f23SAlexander Motin 	cam_periph_sleep(enc->periph, &req, PUSER, "encstat", 0);
2630f6ad3f23SAlexander Motin 
2631f6ad3f23SAlexander Motin 	return (req.result);
2632f6ad3f23SAlexander Motin }
2633f6ad3f23SAlexander Motin 
2634f6ad3f23SAlexander Motin static int
2635f6ad3f23SAlexander Motin ses_get_elm_desc(enc_softc_t *enc, encioc_elm_desc_t *elmd)
2636f6ad3f23SAlexander Motin {
2637f6ad3f23SAlexander Motin 	int i = (int)elmd->elm_idx;
2638f6ad3f23SAlexander Motin 	ses_element_t *elmpriv;
2639f6ad3f23SAlexander Motin 
2640f6ad3f23SAlexander Motin 	/* Assume caller has already checked obj_id validity */
2641f6ad3f23SAlexander Motin 	elmpriv = enc->enc_cache.elm_map[i].elm_private;
2642f6ad3f23SAlexander Motin 	/* object might not have a descriptor */
2643f6ad3f23SAlexander Motin 	if (elmpriv == NULL || elmpriv->descr == NULL) {
2644f6ad3f23SAlexander Motin 		elmd->elm_desc_len = 0;
2645f6ad3f23SAlexander Motin 		return (0);
2646f6ad3f23SAlexander Motin 	}
2647f6ad3f23SAlexander Motin 	if (elmd->elm_desc_len > elmpriv->descr_len)
2648f6ad3f23SAlexander Motin 		elmd->elm_desc_len = elmpriv->descr_len;
2649f6ad3f23SAlexander Motin 	copyout(elmpriv->descr, elmd->elm_desc_str, elmd->elm_desc_len);
2650f6ad3f23SAlexander Motin 	return (0);
2651f6ad3f23SAlexander Motin }
2652f6ad3f23SAlexander Motin 
2653f6ad3f23SAlexander Motin /**
2654f6ad3f23SAlexander Motin  * \brief Respond to ENCIOC_GETELMDEVNAME, providing a device name for the
2655f6ad3f23SAlexander Motin  *	  given object id if one is available.
2656f6ad3f23SAlexander Motin  *
2657f6ad3f23SAlexander Motin  * \param enc	SES softc to examine.
2658f6ad3f23SAlexander Motin  * \param objdn	ioctl structure to read/write device name info.
2659f6ad3f23SAlexander Motin  *
2660f6ad3f23SAlexander Motin  * \return	0 on success, errno otherwise.
2661f6ad3f23SAlexander Motin  */
2662f6ad3f23SAlexander Motin static int
2663f6ad3f23SAlexander Motin ses_get_elm_devnames(enc_softc_t *enc, encioc_elm_devnames_t *elmdn)
2664f6ad3f23SAlexander Motin {
2665f6ad3f23SAlexander Motin 	struct sbuf sb;
2666f6ad3f23SAlexander Motin 	int len;
2667f6ad3f23SAlexander Motin 
2668f6ad3f23SAlexander Motin 	len = elmdn->elm_names_size;
2669f6ad3f23SAlexander Motin 	if (len < 0)
2670f6ad3f23SAlexander Motin 		return (EINVAL);
2671f6ad3f23SAlexander Motin 
2672f6ad3f23SAlexander Motin 	sbuf_new(&sb, elmdn->elm_devnames, len, 0);
2673f6ad3f23SAlexander Motin 
2674f6ad3f23SAlexander Motin 	cam_periph_unlock(enc->periph);
2675f6ad3f23SAlexander Motin 	ses_paths_iter(enc, &enc->enc_cache.elm_map[elmdn->elm_idx],
2676f6ad3f23SAlexander Motin 		       ses_elmdevname_callback, &sb);
2677f6ad3f23SAlexander Motin 	sbuf_finish(&sb);
2678f6ad3f23SAlexander Motin 	elmdn->elm_names_len = sbuf_len(&sb);
2679f6ad3f23SAlexander Motin 	cam_periph_lock(enc->periph);
2680f6ad3f23SAlexander Motin 	return (elmdn->elm_names_len > 0 ? 0 : ENODEV);
2681f6ad3f23SAlexander Motin }
2682f6ad3f23SAlexander Motin 
2683f6ad3f23SAlexander Motin /**
2684f6ad3f23SAlexander Motin  * \brief Send a string to the primary subenclosure using the String Out
2685f6ad3f23SAlexander Motin  * 	  SES diagnostic page.
2686f6ad3f23SAlexander Motin  *
2687f6ad3f23SAlexander Motin  * \param enc	SES enclosure to run the command on.
2688f6ad3f23SAlexander Motin  * \param sstr	SES string structure to operate on
2689f6ad3f23SAlexander Motin  * \param ioc	Ioctl being performed
2690f6ad3f23SAlexander Motin  *
2691f6ad3f23SAlexander Motin  * \return	0 on success, errno otherwise.
2692f6ad3f23SAlexander Motin  */
2693f6ad3f23SAlexander Motin static int
2694f6ad3f23SAlexander Motin ses_handle_string(enc_softc_t *enc, encioc_string_t *sstr, int ioc)
2695f6ad3f23SAlexander Motin {
2696f6ad3f23SAlexander Motin 	int amt, payload, ret;
2697f6ad3f23SAlexander Motin 	char cdb[6];
2698f6ad3f23SAlexander Motin 	uint8_t *buf;
2699f6ad3f23SAlexander Motin 
2700f6ad3f23SAlexander Motin 	/* Implement SES2r20 6.1.6 */
2701f6ad3f23SAlexander Motin 	if (sstr->bufsiz > 0xffff)
2702f6ad3f23SAlexander Motin 		return (EINVAL); /* buffer size too large */
2703f6ad3f23SAlexander Motin 
2704f6ad3f23SAlexander Motin 	if (ioc == ENCIOC_SETSTRING) {
2705f6ad3f23SAlexander Motin 		payload = sstr->bufsiz + 4; /* header for SEND DIAGNOSTIC */
2706f6ad3f23SAlexander Motin 		amt = 0 - payload;
2707f6ad3f23SAlexander Motin 		buf = ENC_MALLOC(payload);
2708f6ad3f23SAlexander Motin 		if (buf == NULL)
2709f6ad3f23SAlexander Motin 			return ENOMEM;
2710f6ad3f23SAlexander Motin 
2711f6ad3f23SAlexander Motin 		ses_page_cdb(cdb, payload, 0, CAM_DIR_OUT);
2712f6ad3f23SAlexander Motin 		/* Construct the page request */
2713f6ad3f23SAlexander Motin 		buf[0] = SesStringOut;
2714f6ad3f23SAlexander Motin 		buf[1] = 0;
2715f6ad3f23SAlexander Motin 		buf[2] = sstr->bufsiz >> 8;
2716f6ad3f23SAlexander Motin 		buf[3] = sstr->bufsiz & 0xff;
2717f6ad3f23SAlexander Motin 		memcpy(&buf[4], sstr->buf, sstr->bufsiz);
2718f6ad3f23SAlexander Motin 	} else if (ioc == ENCIOC_GETSTRING) {
2719f6ad3f23SAlexander Motin 		payload = sstr->bufsiz;
2720f6ad3f23SAlexander Motin 		amt = payload;
2721f6ad3f23SAlexander Motin 		ses_page_cdb(cdb, payload, SesStringIn, CAM_DIR_IN);
2722f6ad3f23SAlexander Motin 		buf = sstr->buf;
2723f6ad3f23SAlexander Motin 	} else
2724f6ad3f23SAlexander Motin 		return EINVAL;
2725f6ad3f23SAlexander Motin 
2726f6ad3f23SAlexander Motin 	ret = enc_runcmd(enc, cdb, 6, buf, &amt);
2727f6ad3f23SAlexander Motin 	if (ioc == ENCIOC_SETSTRING)
2728f6ad3f23SAlexander Motin 		ENC_FREE(buf);
2729f6ad3f23SAlexander Motin 	return ret;
2730f6ad3f23SAlexander Motin }
2731f6ad3f23SAlexander Motin 
2732f6ad3f23SAlexander Motin /**
2733f6ad3f23SAlexander Motin  * \invariant Called with cam_periph mutex held.
2734f6ad3f23SAlexander Motin  */
2735f6ad3f23SAlexander Motin static void
2736f6ad3f23SAlexander Motin ses_poll_status(enc_softc_t *enc)
2737f6ad3f23SAlexander Motin {
2738f6ad3f23SAlexander Motin 	ses_softc_t *ses;
2739f6ad3f23SAlexander Motin 
2740f6ad3f23SAlexander Motin 	ses = enc->enc_private;
2741f6ad3f23SAlexander Motin 	enc_update_request(enc, SES_UPDATE_GETSTATUS);
2742f6ad3f23SAlexander Motin 	if (ses->ses_flags & SES_FLAG_ADDLSTATUS)
2743f6ad3f23SAlexander Motin 		enc_update_request(enc, SES_UPDATE_GETELMADDLSTATUS);
2744f6ad3f23SAlexander Motin }
2745f6ad3f23SAlexander Motin 
2746f6ad3f23SAlexander Motin /**
2747f6ad3f23SAlexander Motin  * \brief Notification received when CAM detects a new device in the
2748f6ad3f23SAlexander Motin  *        SCSI domain in which this SEP resides.
2749f6ad3f23SAlexander Motin  *
2750f6ad3f23SAlexander Motin  * \param enc	SES enclosure instance.
2751f6ad3f23SAlexander Motin  */
2752f6ad3f23SAlexander Motin static void
2753f6ad3f23SAlexander Motin ses_device_found(enc_softc_t *enc)
2754f6ad3f23SAlexander Motin {
2755f6ad3f23SAlexander Motin 	ses_poll_status(enc);
2756f6ad3f23SAlexander Motin 	enc_update_request(enc, SES_PUBLISH_PHYSPATHS);
2757f6ad3f23SAlexander Motin }
2758f6ad3f23SAlexander Motin 
2759f6ad3f23SAlexander Motin static struct enc_vec ses_enc_vec =
2760f6ad3f23SAlexander Motin {
2761f6ad3f23SAlexander Motin 	.softc_invalidate	= ses_softc_invalidate,
2762f6ad3f23SAlexander Motin 	.softc_cleanup		= ses_softc_cleanup,
2763f6ad3f23SAlexander Motin 	.init_enc		= ses_init_enc,
2764f6ad3f23SAlexander Motin 	.get_enc_status		= ses_get_enc_status,
2765f6ad3f23SAlexander Motin 	.set_enc_status		= ses_set_enc_status,
2766f6ad3f23SAlexander Motin 	.get_elm_status		= ses_get_elm_status,
2767f6ad3f23SAlexander Motin 	.set_elm_status		= ses_set_elm_status,
2768f6ad3f23SAlexander Motin 	.get_elm_desc		= ses_get_elm_desc,
2769f6ad3f23SAlexander Motin 	.get_elm_devnames	= ses_get_elm_devnames,
2770f6ad3f23SAlexander Motin 	.handle_string		= ses_handle_string,
2771f6ad3f23SAlexander Motin 	.device_found		= ses_device_found,
2772f6ad3f23SAlexander Motin 	.poll_status		= ses_poll_status
2773f6ad3f23SAlexander Motin };
2774f6ad3f23SAlexander Motin 
2775f6ad3f23SAlexander Motin /**
2776f6ad3f23SAlexander Motin  * \brief Initialize a new SES instance.
2777f6ad3f23SAlexander Motin  *
2778f6ad3f23SAlexander Motin  * \param enc		SES softc structure to set up the instance in.
2779f6ad3f23SAlexander Motin  * \param doinit	Do the initialization (see main driver).
2780f6ad3f23SAlexander Motin  *
2781f6ad3f23SAlexander Motin  * \return		0 on success, errno otherwise.
2782f6ad3f23SAlexander Motin  */
2783f6ad3f23SAlexander Motin int
2784f6ad3f23SAlexander Motin ses_softc_init(enc_softc_t *enc)
2785f6ad3f23SAlexander Motin {
2786f6ad3f23SAlexander Motin 	ses_softc_t *ses_softc;
2787f6ad3f23SAlexander Motin 
2788f6ad3f23SAlexander Motin 	CAM_DEBUG(enc->periph->path, CAM_DEBUG_SUBTRACE,
2789f6ad3f23SAlexander Motin 	    ("entering enc_softc_init(%p)\n", enc));
2790f6ad3f23SAlexander Motin 
2791f6ad3f23SAlexander Motin 	enc->enc_vec = ses_enc_vec;
2792f6ad3f23SAlexander Motin 	enc->enc_fsm_states = enc_fsm_states;
2793f6ad3f23SAlexander Motin 
2794f6ad3f23SAlexander Motin 	if (enc->enc_private == NULL)
2795f6ad3f23SAlexander Motin 		enc->enc_private = ENC_MALLOCZ(sizeof(ses_softc_t));
2796f6ad3f23SAlexander Motin 	if (enc->enc_cache.private == NULL)
2797f6ad3f23SAlexander Motin 		enc->enc_cache.private = ENC_MALLOCZ(sizeof(ses_cache_t));
2798f6ad3f23SAlexander Motin 	if (enc->enc_daemon_cache.private == NULL)
2799f6ad3f23SAlexander Motin 		enc->enc_daemon_cache.private =
2800f6ad3f23SAlexander Motin 		     ENC_MALLOCZ(sizeof(ses_cache_t));
2801f6ad3f23SAlexander Motin 
2802f6ad3f23SAlexander Motin 	if (enc->enc_private == NULL
2803f6ad3f23SAlexander Motin 	 || enc->enc_cache.private == NULL
2804f6ad3f23SAlexander Motin 	 || enc->enc_daemon_cache.private == NULL) {
2805f6ad3f23SAlexander Motin 		ENC_FREE_AND_NULL(enc->enc_private);
2806f6ad3f23SAlexander Motin 		ENC_FREE_AND_NULL(enc->enc_cache.private);
2807f6ad3f23SAlexander Motin 		ENC_FREE_AND_NULL(enc->enc_daemon_cache.private);
2808f6ad3f23SAlexander Motin 		return (ENOMEM);
2809f6ad3f23SAlexander Motin 	}
2810f6ad3f23SAlexander Motin 
2811f6ad3f23SAlexander Motin 	ses_softc = enc->enc_private;
2812f6ad3f23SAlexander Motin 	TAILQ_INIT(&ses_softc->ses_requests);
2813f6ad3f23SAlexander Motin 	TAILQ_INIT(&ses_softc->ses_pending_requests);
2814f6ad3f23SAlexander Motin 
2815f6ad3f23SAlexander Motin 	enc_update_request(enc, SES_UPDATE_PAGES);
2816f6ad3f23SAlexander Motin 
2817f6ad3f23SAlexander Motin 	// XXX: Move this to the FSM so it doesn't hang init
2818f6ad3f23SAlexander Motin 	if (0) (void) ses_set_timed_completion(enc, 1);
2819f6ad3f23SAlexander Motin 
2820f6ad3f23SAlexander Motin 	return (0);
2821f6ad3f23SAlexander Motin }
2822f6ad3f23SAlexander Motin 
2823