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