1229997Sken/*- 2229997Sken * Copyright (c) 2004, 2005 Silicon Graphics International Corp. 3229997Sken * All rights reserved. 4229997Sken * 5229997Sken * Redistribution and use in source and binary forms, with or without 6229997Sken * modification, are permitted provided that the following conditions 7229997Sken * are met: 8229997Sken * 1. Redistributions of source code must retain the above copyright 9229997Sken * notice, this list of conditions, and the following disclaimer, 10229997Sken * without modification. 11229997Sken * 2. Redistributions in binary form must reproduce at minimum a disclaimer 12229997Sken * substantially similar to the "NO WARRANTY" disclaimer below 13229997Sken * ("Disclaimer") and any redistribution must be conditioned upon 14229997Sken * including a substantially similar Disclaimer requirement for further 15229997Sken * binary redistribution. 16229997Sken * 17229997Sken * NO WARRANTY 18229997Sken * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 19229997Sken * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 20229997Sken * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR 21229997Sken * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 22229997Sken * HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 23229997Sken * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 24229997Sken * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 25229997Sken * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 26229997Sken * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING 27229997Sken * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 28229997Sken * POSSIBILITY OF SUCH DAMAGES. 29229997Sken * 30229997Sken * $Id: //depot/users/kenm/FreeBSD-test2/sys/cam/ctl/ctl_frontend_internal.c#5 $ 31229997Sken */ 32229997Sken/* 33229997Sken * CTL kernel internal frontend target driver. This allows kernel-level 34229997Sken * clients to send commands into CTL. 35229997Sken * 36229997Sken * This has elements of a FETD (e.g. it has to set tag numbers, initiator, 37229997Sken * port, target, and LUN) and elements of an initiator (LUN discovery and 38229997Sken * probing, error recovery, command initiation). Even though this has some 39229997Sken * initiator type elements, this is not intended to be a full fledged 40229997Sken * initiator layer. It is only intended to send a limited number of 41229997Sken * commands to a well known target layer. 42229997Sken * 43229997Sken * To be able to fulfill the role of a full initiator layer, it would need 44229997Sken * a whole lot more functionality. 45229997Sken * 46229997Sken * Author: Ken Merry <ken@FreeBSD.org> 47229997Sken * 48229997Sken */ 49229997Sken 50229997Sken#include <sys/cdefs.h> 51229997Sken__FBSDID("$FreeBSD$"); 52229997Sken 53229997Sken#include <sys/param.h> 54229997Sken#include <sys/systm.h> 55229997Sken#include <sys/kernel.h> 56229997Sken#include <sys/types.h> 57229997Sken#include <sys/malloc.h> 58249510Strasz#include <sys/module.h> 59229997Sken#include <sys/lock.h> 60229997Sken#include <sys/mutex.h> 61229997Sken#include <sys/condvar.h> 62229997Sken#include <sys/queue.h> 63229997Sken#include <sys/sbuf.h> 64237824Sken#include <sys/sysctl.h> 65265654Smav#include <vm/uma.h> 66229997Sken#include <cam/scsi/scsi_all.h> 67229997Sken#include <cam/scsi/scsi_da.h> 68229997Sken#include <cam/ctl/ctl_io.h> 69229997Sken#include <cam/ctl/ctl.h> 70229997Sken#include <cam/ctl/ctl_frontend.h> 71229997Sken#include <cam/ctl/ctl_frontend_internal.h> 72229997Sken#include <cam/ctl/ctl_backend.h> 73229997Sken#include <cam/ctl/ctl_ioctl.h> 74229997Sken#include <cam/ctl/ctl_util.h> 75229997Sken#include <cam/ctl/ctl_ha.h> 76229997Sken#include <cam/ctl/ctl_private.h> 77229997Sken#include <cam/ctl/ctl_debug.h> 78229997Sken#include <cam/ctl/ctl_scsi_all.h> 79229997Sken#include <cam/ctl/ctl_error.h> 80229997Sken 81229997Sken/* 82229997Sken * Task structure: 83229997Sken * - overall metatask, different potential metatask types (e.g. forced 84229997Sken * shutdown, gentle shutdown) 85229997Sken * - forced shutdown metatask: 86229997Sken * - states: report luns, pending, done? 87229997Sken * - list of luns pending, with the relevant I/O for that lun attached. 88229997Sken * This would allow moving ahead on LUNs with no errors, and going 89229997Sken * into error recovery on LUNs with problems. Per-LUN states might 90229997Sken * include inquiry, stop/offline, done. 91229997Sken * 92229997Sken * Use LUN enable for LUN list instead of getting it manually? We'd still 93229997Sken * need inquiry data for each LUN. 94229997Sken * 95229997Sken * How to handle processor LUN w.r.t. found/stopped counts? 96229997Sken */ 97229997Sken#ifdef oldapi 98229997Skentypedef enum { 99229997Sken CFI_TASK_NONE, 100229997Sken CFI_TASK_SHUTDOWN, 101229997Sken CFI_TASK_STARTUP 102229997Sken} cfi_tasktype; 103229997Sken 104229997Skenstruct cfi_task_startstop { 105229997Sken int total_luns; 106229997Sken int luns_complete; 107229997Sken int luns_failed; 108229997Sken cfi_cb_t callback; 109229997Sken void *callback_arg; 110229997Sken /* XXX KDM add more fields here */ 111229997Sken}; 112229997Sken 113229997Skenunion cfi_taskinfo { 114229997Sken struct cfi_task_startstop startstop; 115229997Sken}; 116229997Sken 117229997Skenstruct cfi_metatask { 118229997Sken cfi_tasktype tasktype; 119229997Sken cfi_mt_status status; 120229997Sken union cfi_taskinfo taskinfo; 121229997Sken void *cfi_context; 122229997Sken STAILQ_ENTRY(cfi_metatask) links; 123229997Sken}; 124229997Sken#endif 125229997Sken 126229997Skentypedef enum { 127229997Sken CFI_ERR_RETRY = 0x000, 128229997Sken CFI_ERR_FAIL = 0x001, 129229997Sken CFI_ERR_LUN_RESET = 0x002, 130229997Sken CFI_ERR_MASK = 0x0ff, 131229997Sken CFI_ERR_NO_DECREMENT = 0x100 132229997Sken} cfi_error_action; 133229997Sken 134229997Skentypedef enum { 135229997Sken CFI_ERR_SOFT, 136229997Sken CFI_ERR_HARD 137229997Sken} cfi_error_policy; 138229997Sken 139229997Skentypedef enum { 140229997Sken CFI_LUN_INQUIRY, 141229997Sken CFI_LUN_READCAPACITY, 142229997Sken CFI_LUN_READCAPACITY_16, 143229997Sken CFI_LUN_READY 144229997Sken} cfi_lun_state; 145229997Sken 146229997Skenstruct cfi_lun { 147229997Sken struct ctl_id target_id; 148229997Sken int lun_id; 149229997Sken struct scsi_inquiry_data inq_data; 150229997Sken uint64_t num_blocks; 151229997Sken uint32_t blocksize; 152229997Sken int blocksize_powerof2; 153229997Sken uint32_t cur_tag_num; 154229997Sken cfi_lun_state state; 155229997Sken struct cfi_softc *softc; 156229997Sken STAILQ_HEAD(, cfi_lun_io) io_list; 157229997Sken STAILQ_ENTRY(cfi_lun) links; 158229997Sken}; 159229997Sken 160229997Skenstruct cfi_lun_io { 161229997Sken struct cfi_lun *lun; 162229997Sken struct cfi_metatask *metatask; 163229997Sken cfi_error_policy policy; 164229997Sken void (*done_function)(union ctl_io *io); 165229997Sken union ctl_io *ctl_io; 166229997Sken struct cfi_lun_io *orig_lun_io; 167229997Sken STAILQ_ENTRY(cfi_lun_io) links; 168229997Sken}; 169229997Sken 170229997Skentypedef enum { 171229997Sken CFI_NONE = 0x00, 172229997Sken CFI_ONLINE = 0x01, 173229997Sken} cfi_flags; 174229997Sken 175229997Skenstruct cfi_softc { 176229997Sken struct ctl_frontend fe; 177229997Sken char fe_name[40]; 178229997Sken struct mtx lock; 179229997Sken cfi_flags flags; 180229997Sken STAILQ_HEAD(, cfi_lun) lun_list; 181229997Sken STAILQ_HEAD(, cfi_metatask) metatask_list; 182229997Sken}; 183229997Sken 184229997SkenMALLOC_DEFINE(M_CTL_CFI, "ctlcfi", "CTL CFI"); 185229997Sken 186265654Smavstatic uma_zone_t cfi_lun_zone; 187265654Smavstatic uma_zone_t cfi_metatask_zone; 188265654Smav 189229997Skenstatic struct cfi_softc fetd_internal_softc; 190237941Skenextern int ctl_disable; 191229997Sken 192249510Straszint cfi_init(void); 193229997Skenvoid cfi_shutdown(void) __unused; 194229997Skenstatic void cfi_online(void *arg); 195229997Skenstatic void cfi_offline(void *arg); 196229997Skenstatic int cfi_targ_enable(void *arg, struct ctl_id targ_id); 197229997Skenstatic int cfi_targ_disable(void *arg, struct ctl_id targ_id); 198229997Skenstatic int cfi_lun_enable(void *arg, struct ctl_id target_id, int lun_id); 199229997Skenstatic int cfi_lun_disable(void *arg, struct ctl_id target_id, int lun_id); 200229997Skenstatic void cfi_datamove(union ctl_io *io); 201229997Skenstatic cfi_error_action cfi_checkcond_parse(union ctl_io *io, 202229997Sken struct cfi_lun_io *lun_io); 203229997Skenstatic cfi_error_action cfi_error_parse(union ctl_io *io, 204229997Sken struct cfi_lun_io *lun_io); 205229997Skenstatic void cfi_init_io(union ctl_io *io, struct cfi_lun *lun, 206229997Sken struct cfi_metatask *metatask, cfi_error_policy policy, 207229997Sken int retries, struct cfi_lun_io *orig_lun_io, 208229997Sken void (*done_function)(union ctl_io *io)); 209229997Skenstatic void cfi_done(union ctl_io *io); 210229997Skenstatic void cfi_lun_probe_done(union ctl_io *io); 211229997Skenstatic void cfi_lun_probe(struct cfi_lun *lun, int have_lock); 212229997Skenstatic void cfi_metatask_done(struct cfi_softc *softc, 213229997Sken struct cfi_metatask *metatask); 214229997Skenstatic void cfi_metatask_bbr_errorparse(struct cfi_metatask *metatask, 215229997Sken union ctl_io *io); 216229997Skenstatic void cfi_metatask_io_done(union ctl_io *io); 217229997Skenstatic void cfi_err_recovery_done(union ctl_io *io); 218229997Skenstatic void cfi_lun_io_done(union ctl_io *io); 219229997Sken 220249510Straszstatic int cfi_module_event_handler(module_t, int /*modeventtype_t*/, void *); 221229997Sken 222249510Straszstatic moduledata_t cfi_moduledata = { 223249510Strasz "ctlcfi", 224249510Strasz cfi_module_event_handler, 225249510Strasz NULL 226249510Strasz}; 227249510Strasz 228249510StraszDECLARE_MODULE(ctlcfi, cfi_moduledata, SI_SUB_CONFIGURE, SI_ORDER_FOURTH); 229249510StraszMODULE_VERSION(ctlcfi, 1); 230249510StraszMODULE_DEPEND(ctlcfi, ctl, 1, 1, 1); 231249510Strasz 232249510Straszint 233229997Skencfi_init(void) 234229997Sken{ 235229997Sken struct cfi_softc *softc; 236229997Sken struct ctl_frontend *fe; 237229997Sken int retval; 238229997Sken 239229997Sken softc = &fetd_internal_softc; 240229997Sken 241229997Sken fe = &softc->fe; 242229997Sken 243229997Sken retval = 0; 244229997Sken 245237941Sken /* If we're disabled, don't initialize */ 246237941Sken if (ctl_disable != 0) 247249510Strasz return (0); 248237941Sken 249229997Sken if (sizeof(struct cfi_lun_io) > CTL_PORT_PRIV_SIZE) { 250229997Sken printf("%s: size of struct cfi_lun_io %zd > " 251229997Sken "CTL_PORT_PRIV_SIZE %d\n", __func__, 252229997Sken sizeof(struct cfi_lun_io), 253229997Sken CTL_PORT_PRIV_SIZE); 254229997Sken } 255256217Smav memset(softc, 0, sizeof(*softc)); 256229997Sken 257229997Sken mtx_init(&softc->lock, "CTL frontend mutex", NULL, MTX_DEF); 258229997Sken softc->flags |= CTL_FLAG_MASTER_SHELF; 259229997Sken 260229997Sken STAILQ_INIT(&softc->lun_list); 261229997Sken STAILQ_INIT(&softc->metatask_list); 262229997Sken sprintf(softc->fe_name, "CTL internal"); 263229997Sken fe->port_type = CTL_PORT_INTERNAL; 264229997Sken fe->num_requested_ctl_io = 100; 265229997Sken fe->port_name = softc->fe_name; 266229997Sken fe->port_online = cfi_online; 267229997Sken fe->port_offline = cfi_offline; 268229997Sken fe->onoff_arg = softc; 269229997Sken fe->targ_enable = cfi_targ_enable; 270229997Sken fe->targ_disable = cfi_targ_disable; 271229997Sken fe->lun_enable = cfi_lun_enable; 272229997Sken fe->lun_disable = cfi_lun_disable; 273229997Sken fe->targ_lun_arg = softc; 274229997Sken fe->fe_datamove = cfi_datamove; 275229997Sken fe->fe_done = cfi_done; 276229997Sken fe->max_targets = 15; 277229997Sken fe->max_target_id = 15; 278229997Sken 279229997Sken if (ctl_frontend_register(fe, (softc->flags & CTL_FLAG_MASTER_SHELF)) != 0) 280229997Sken { 281229997Sken printf("%s: internal frontend registration failed\n", __func__); 282265654Smav return (0); 283229997Sken } 284229997Sken 285265654Smav cfi_lun_zone = uma_zcreate("cfi_lun", sizeof(struct cfi_lun), 286265654Smav NULL, NULL, NULL, NULL, UMA_ALIGN_PTR, 0); 287265654Smav cfi_metatask_zone = uma_zcreate("cfi_metatask", sizeof(struct cfi_metatask), 288265654Smav NULL, NULL, NULL, NULL, UMA_ALIGN_PTR, 0); 289229997Sken 290249510Strasz return (0); 291229997Sken} 292229997Sken 293229997Skenvoid 294229997Skencfi_shutdown(void) 295229997Sken{ 296229997Sken struct cfi_softc *softc; 297229997Sken 298229997Sken softc = &fetd_internal_softc; 299229997Sken 300229997Sken /* 301229997Sken * XXX KDM need to clear out any I/O pending on each LUN. 302229997Sken */ 303229997Sken if (ctl_frontend_deregister(&softc->fe) != 0) 304229997Sken printf("%s: ctl_frontend_deregister() failed\n", __func__); 305229997Sken 306265654Smav uma_zdestroy(cfi_lun_zone); 307265654Smav uma_zdestroy(cfi_metatask_zone); 308229997Sken} 309229997Sken 310249510Straszstatic int 311249510Straszcfi_module_event_handler(module_t mod, int what, void *arg) 312249510Strasz{ 313249510Strasz 314249510Strasz switch (what) { 315249510Strasz case MOD_LOAD: 316249510Strasz return (cfi_init()); 317249510Strasz case MOD_UNLOAD: 318249510Strasz return (EBUSY); 319249510Strasz default: 320249510Strasz return (EOPNOTSUPP); 321249510Strasz } 322249510Strasz} 323249510Strasz 324229997Skenstatic void 325229997Skencfi_online(void *arg) 326229997Sken{ 327229997Sken struct cfi_softc *softc; 328229997Sken struct cfi_lun *lun; 329229997Sken 330229997Sken softc = (struct cfi_softc *)arg; 331229997Sken 332229997Sken softc->flags |= CFI_ONLINE; 333229997Sken 334229997Sken /* 335229997Sken * Go through and kick off the probe for each lun. Should we check 336229997Sken * the LUN flags here to determine whether or not to probe it? 337229997Sken */ 338229997Sken mtx_lock(&softc->lock); 339229997Sken STAILQ_FOREACH(lun, &softc->lun_list, links) 340229997Sken cfi_lun_probe(lun, /*have_lock*/ 1); 341229997Sken mtx_unlock(&softc->lock); 342229997Sken} 343229997Sken 344229997Skenstatic void 345229997Skencfi_offline(void *arg) 346229997Sken{ 347229997Sken struct cfi_softc *softc; 348229997Sken 349229997Sken softc = (struct cfi_softc *)arg; 350229997Sken 351229997Sken softc->flags &= ~CFI_ONLINE; 352229997Sken} 353229997Sken 354229997Skenstatic int 355229997Skencfi_targ_enable(void *arg, struct ctl_id targ_id) 356229997Sken{ 357229997Sken return (0); 358229997Sken} 359229997Sken 360229997Skenstatic int 361229997Skencfi_targ_disable(void *arg, struct ctl_id targ_id) 362229997Sken{ 363229997Sken return (0); 364229997Sken} 365229997Sken 366229997Skenstatic int 367229997Skencfi_lun_enable(void *arg, struct ctl_id target_id, int lun_id) 368229997Sken{ 369229997Sken struct cfi_softc *softc; 370229997Sken struct cfi_lun *lun; 371229997Sken int found; 372229997Sken 373229997Sken softc = (struct cfi_softc *)arg; 374229997Sken 375229997Sken found = 0; 376229997Sken mtx_lock(&softc->lock); 377229997Sken STAILQ_FOREACH(lun, &softc->lun_list, links) { 378229997Sken if ((lun->target_id.id == target_id.id) 379229997Sken && (lun->lun_id == lun_id)) { 380229997Sken found = 1; 381229997Sken break; 382229997Sken } 383229997Sken } 384229997Sken mtx_unlock(&softc->lock); 385229997Sken 386229997Sken /* 387229997Sken * If we already have this target/LUN, there is no reason to add 388229997Sken * it to our lists again. 389229997Sken */ 390229997Sken if (found != 0) 391229997Sken return (0); 392229997Sken 393265654Smav lun = uma_zalloc(cfi_lun_zone, M_NOWAIT | M_ZERO); 394265654Smav if (lun == NULL) { 395229997Sken printf("%s: unable to allocate LUN structure\n", __func__); 396229997Sken return (1); 397229997Sken } 398229997Sken 399229997Sken lun->target_id = target_id; 400229997Sken lun->lun_id = lun_id; 401229997Sken lun->cur_tag_num = 0; 402229997Sken lun->state = CFI_LUN_INQUIRY; 403229997Sken lun->softc = softc; 404229997Sken STAILQ_INIT(&lun->io_list); 405229997Sken 406229997Sken mtx_lock(&softc->lock); 407229997Sken STAILQ_INSERT_TAIL(&softc->lun_list, lun, links); 408229997Sken mtx_unlock(&softc->lock); 409229997Sken 410229997Sken cfi_lun_probe(lun, /*have_lock*/ 0); 411229997Sken 412229997Sken return (0); 413229997Sken} 414229997Sken 415229997Skenstatic int 416229997Skencfi_lun_disable(void *arg, struct ctl_id target_id, int lun_id) 417229997Sken{ 418229997Sken struct cfi_softc *softc; 419229997Sken struct cfi_lun *lun; 420229997Sken int found; 421229997Sken 422229997Sken softc = (struct cfi_softc *)arg; 423229997Sken 424229997Sken found = 0; 425229997Sken 426229997Sken /* 427229997Sken * XXX KDM need to do an invalidate and then a free when any 428229997Sken * pending I/O has completed. Or do we? CTL won't free a LUN 429229997Sken * while any I/O is pending. So we won't get this notification 430229997Sken * unless any I/O we have pending on a LUN has completed. 431229997Sken */ 432229997Sken mtx_lock(&softc->lock); 433229997Sken STAILQ_FOREACH(lun, &softc->lun_list, links) { 434229997Sken if ((lun->target_id.id == target_id.id) 435229997Sken && (lun->lun_id == lun_id)) { 436229997Sken found = 1; 437229997Sken break; 438229997Sken } 439229997Sken } 440229997Sken if (found != 0) 441229997Sken STAILQ_REMOVE(&softc->lun_list, lun, cfi_lun, links); 442229997Sken 443229997Sken mtx_unlock(&softc->lock); 444229997Sken 445229997Sken if (found == 0) { 446229997Sken printf("%s: can't find target %ju lun %d\n", __func__, 447229997Sken (uintmax_t)target_id.id, lun_id); 448229997Sken return (1); 449229997Sken } 450229997Sken 451265654Smav uma_zfree(cfi_lun_zone, lun); 452229997Sken 453229997Sken return (0); 454229997Sken} 455229997Sken 456229997Skenstatic void 457229997Skencfi_datamove(union ctl_io *io) 458229997Sken{ 459229997Sken struct ctl_sg_entry *ext_sglist, *kern_sglist; 460229997Sken struct ctl_sg_entry ext_entry, kern_entry; 461229997Sken int ext_sglen, ext_sg_entries, kern_sg_entries; 462229997Sken int ext_sg_start, ext_offset; 463229997Sken int len_to_copy, len_copied; 464229997Sken int kern_watermark, ext_watermark; 465229997Sken int ext_sglist_malloced; 466229997Sken struct ctl_scsiio *ctsio; 467229997Sken int i, j; 468229997Sken 469229997Sken ext_sglist_malloced = 0; 470229997Sken ext_sg_start = 0; 471229997Sken ext_offset = 0; 472229997Sken ext_sglist = NULL; 473229997Sken 474229997Sken CTL_DEBUG_PRINT(("%s\n", __func__)); 475229997Sken 476229997Sken ctsio = &io->scsiio; 477229997Sken 478229997Sken /* 479229997Sken * If this is the case, we're probably doing a BBR read and don't 480229997Sken * actually need to transfer the data. This will effectively 481229997Sken * bit-bucket the data. 482229997Sken */ 483229997Sken if (ctsio->ext_data_ptr == NULL) 484229997Sken goto bailout; 485229997Sken 486229997Sken /* 487229997Sken * To simplify things here, if we have a single buffer, stick it in 488229997Sken * a S/G entry and just make it a single entry S/G list. 489229997Sken */ 490229997Sken if (ctsio->io_hdr.flags & CTL_FLAG_EDPTR_SGLIST) { 491229997Sken int len_seen; 492229997Sken 493229997Sken ext_sglen = ctsio->ext_sg_entries * sizeof(*ext_sglist); 494229997Sken 495229997Sken ext_sglist = (struct ctl_sg_entry *)malloc(ext_sglen, M_CTL_CFI, 496229997Sken M_WAITOK); 497229997Sken ext_sglist_malloced = 1; 498229997Sken if (memcpy(ext_sglist, ctsio->ext_data_ptr, ext_sglen) != 0) { 499229997Sken ctl_set_internal_failure(ctsio, 500229997Sken /*sks_valid*/ 0, 501229997Sken /*retry_count*/ 0); 502229997Sken goto bailout; 503229997Sken } 504229997Sken ext_sg_entries = ctsio->ext_sg_entries; 505229997Sken len_seen = 0; 506229997Sken for (i = 0; i < ext_sg_entries; i++) { 507229997Sken if ((len_seen + ext_sglist[i].len) >= 508229997Sken ctsio->ext_data_filled) { 509229997Sken ext_sg_start = i; 510229997Sken ext_offset = ctsio->ext_data_filled - len_seen; 511229997Sken break; 512229997Sken } 513229997Sken len_seen += ext_sglist[i].len; 514229997Sken } 515229997Sken } else { 516229997Sken ext_sglist = &ext_entry; 517229997Sken ext_sglist->addr = ctsio->ext_data_ptr; 518229997Sken ext_sglist->len = ctsio->ext_data_len; 519229997Sken ext_sg_entries = 1; 520229997Sken ext_sg_start = 0; 521229997Sken ext_offset = ctsio->ext_data_filled; 522229997Sken } 523229997Sken 524229997Sken if (ctsio->kern_sg_entries > 0) { 525229997Sken kern_sglist = (struct ctl_sg_entry *)ctsio->kern_data_ptr; 526229997Sken kern_sg_entries = ctsio->kern_sg_entries; 527229997Sken } else { 528229997Sken kern_sglist = &kern_entry; 529229997Sken kern_sglist->addr = ctsio->kern_data_ptr; 530229997Sken kern_sglist->len = ctsio->kern_data_len; 531229997Sken kern_sg_entries = 1; 532229997Sken } 533229997Sken 534229997Sken 535229997Sken kern_watermark = 0; 536229997Sken ext_watermark = ext_offset; 537229997Sken len_copied = 0; 538229997Sken for (i = ext_sg_start, j = 0; 539229997Sken i < ext_sg_entries && j < kern_sg_entries;) { 540229997Sken uint8_t *ext_ptr, *kern_ptr; 541229997Sken 542229997Sken len_to_copy = ctl_min(ext_sglist[i].len - ext_watermark, 543229997Sken kern_sglist[j].len - kern_watermark); 544229997Sken 545229997Sken ext_ptr = (uint8_t *)ext_sglist[i].addr; 546229997Sken ext_ptr = ext_ptr + ext_watermark; 547229997Sken if (io->io_hdr.flags & CTL_FLAG_BUS_ADDR) { 548229997Sken /* 549229997Sken * XXX KDM fix this! 550229997Sken */ 551229997Sken panic("need to implement bus address support"); 552229997Sken#if 0 553229997Sken kern_ptr = bus_to_virt(kern_sglist[j].addr); 554229997Sken#endif 555229997Sken } else 556229997Sken kern_ptr = (uint8_t *)kern_sglist[j].addr; 557229997Sken kern_ptr = kern_ptr + kern_watermark; 558229997Sken 559229997Sken kern_watermark += len_to_copy; 560229997Sken ext_watermark += len_to_copy; 561229997Sken 562229997Sken if ((ctsio->io_hdr.flags & CTL_FLAG_DATA_MASK) == 563229997Sken CTL_FLAG_DATA_IN) { 564229997Sken CTL_DEBUG_PRINT(("%s: copying %d bytes to user\n", 565229997Sken __func__, len_to_copy)); 566229997Sken CTL_DEBUG_PRINT(("%s: from %p to %p\n", __func__, 567229997Sken kern_ptr, ext_ptr)); 568229997Sken memcpy(ext_ptr, kern_ptr, len_to_copy); 569229997Sken } else { 570229997Sken CTL_DEBUG_PRINT(("%s: copying %d bytes from user\n", 571229997Sken __func__, len_to_copy)); 572229997Sken CTL_DEBUG_PRINT(("%s: from %p to %p\n", __func__, 573229997Sken ext_ptr, kern_ptr)); 574229997Sken memcpy(kern_ptr, ext_ptr, len_to_copy); 575229997Sken } 576229997Sken 577229997Sken len_copied += len_to_copy; 578229997Sken 579229997Sken if (ext_sglist[i].len == ext_watermark) { 580229997Sken i++; 581229997Sken ext_watermark = 0; 582229997Sken } 583229997Sken 584229997Sken if (kern_sglist[j].len == kern_watermark) { 585229997Sken j++; 586229997Sken kern_watermark = 0; 587229997Sken } 588229997Sken } 589229997Sken 590229997Sken ctsio->ext_data_filled += len_copied; 591229997Sken 592229997Sken CTL_DEBUG_PRINT(("%s: ext_sg_entries: %d, kern_sg_entries: %d\n", 593229997Sken __func__, ext_sg_entries, kern_sg_entries)); 594229997Sken CTL_DEBUG_PRINT(("%s: ext_data_len = %d, kern_data_len = %d\n", 595229997Sken __func__, ctsio->ext_data_len, ctsio->kern_data_len)); 596229997Sken 597229997Sken 598229997Sken /* XXX KDM set residual?? */ 599229997Skenbailout: 600229997Sken 601229997Sken if (ext_sglist_malloced != 0) 602229997Sken free(ext_sglist, M_CTL_CFI); 603229997Sken 604229997Sken io->scsiio.be_move_done(io); 605229997Sken 606229997Sken return; 607229997Sken} 608229997Sken 609229997Sken/* 610229997Sken * For any sort of check condition, busy, etc., we just retry. We do not 611229997Sken * decrement the retry count for unit attention type errors. These are 612229997Sken * normal, and we want to save the retry count for "real" errors. Otherwise, 613229997Sken * we could end up with situations where a command will succeed in some 614229997Sken * situations and fail in others, depending on whether a unit attention is 615229997Sken * pending. Also, some of our error recovery actions, most notably the 616229997Sken * LUN reset action, will cause a unit attention. 617229997Sken * 618229997Sken * We can add more detail here later if necessary. 619229997Sken */ 620229997Skenstatic cfi_error_action 621229997Skencfi_checkcond_parse(union ctl_io *io, struct cfi_lun_io *lun_io) 622229997Sken{ 623229997Sken cfi_error_action error_action; 624229997Sken int error_code, sense_key, asc, ascq; 625229997Sken 626229997Sken /* 627229997Sken * Default to retrying the command. 628229997Sken */ 629229997Sken error_action = CFI_ERR_RETRY; 630229997Sken 631229997Sken scsi_extract_sense_len(&io->scsiio.sense_data, 632229997Sken io->scsiio.sense_len, 633229997Sken &error_code, 634229997Sken &sense_key, 635229997Sken &asc, 636229997Sken &ascq, 637229997Sken /*show_errors*/ 1); 638229997Sken 639229997Sken switch (error_code) { 640229997Sken case SSD_DEFERRED_ERROR: 641229997Sken case SSD_DESC_DEFERRED_ERROR: 642229997Sken error_action |= CFI_ERR_NO_DECREMENT; 643229997Sken break; 644229997Sken case SSD_CURRENT_ERROR: 645229997Sken case SSD_DESC_CURRENT_ERROR: 646229997Sken default: { 647229997Sken switch (sense_key) { 648229997Sken case SSD_KEY_UNIT_ATTENTION: 649229997Sken error_action |= CFI_ERR_NO_DECREMENT; 650229997Sken break; 651229997Sken case SSD_KEY_HARDWARE_ERROR: 652229997Sken /* 653229997Sken * This is our generic "something bad happened" 654229997Sken * error code. It often isn't recoverable. 655229997Sken */ 656229997Sken if ((asc == 0x44) && (ascq == 0x00)) 657229997Sken error_action = CFI_ERR_FAIL; 658229997Sken break; 659229997Sken case SSD_KEY_NOT_READY: 660229997Sken /* 661229997Sken * If the LUN is powered down, there likely isn't 662229997Sken * much point in retrying right now. 663229997Sken */ 664229997Sken if ((asc == 0x04) && (ascq == 0x02)) 665229997Sken error_action = CFI_ERR_FAIL; 666229997Sken /* 667229997Sken * If the LUN is offline, there probably isn't much 668229997Sken * point in retrying, either. 669229997Sken */ 670229997Sken if ((asc == 0x04) && (ascq == 0x03)) 671229997Sken error_action = CFI_ERR_FAIL; 672229997Sken break; 673229997Sken } 674229997Sken } 675229997Sken } 676229997Sken 677229997Sken return (error_action); 678229997Sken} 679229997Sken 680229997Skenstatic cfi_error_action 681229997Skencfi_error_parse(union ctl_io *io, struct cfi_lun_io *lun_io) 682229997Sken{ 683229997Sken cfi_error_action error_action; 684229997Sken 685229997Sken error_action = CFI_ERR_RETRY; 686229997Sken 687229997Sken switch (io->io_hdr.io_type) { 688229997Sken case CTL_IO_SCSI: 689229997Sken switch (io->io_hdr.status & CTL_STATUS_MASK) { 690229997Sken case CTL_SCSI_ERROR: 691229997Sken switch (io->scsiio.scsi_status) { 692229997Sken case SCSI_STATUS_RESERV_CONFLICT: 693229997Sken /* 694229997Sken * For a reservation conflict, we'll usually 695229997Sken * want the hard error recovery policy, so 696229997Sken * we'll reset the LUN. 697229997Sken */ 698229997Sken if (lun_io->policy == CFI_ERR_HARD) 699229997Sken error_action = 700229997Sken CFI_ERR_LUN_RESET; 701229997Sken else 702229997Sken error_action = 703229997Sken CFI_ERR_RETRY; 704229997Sken break; 705229997Sken case SCSI_STATUS_CHECK_COND: 706229997Sken default: 707229997Sken error_action = cfi_checkcond_parse(io, lun_io); 708229997Sken break; 709229997Sken } 710229997Sken break; 711229997Sken default: 712229997Sken error_action = CFI_ERR_RETRY; 713229997Sken break; 714229997Sken } 715229997Sken break; 716229997Sken case CTL_IO_TASK: 717229997Sken /* 718229997Sken * In theory task management commands shouldn't fail... 719229997Sken */ 720229997Sken error_action = CFI_ERR_RETRY; 721229997Sken break; 722229997Sken default: 723229997Sken printf("%s: invalid ctl_io type %d\n", __func__, 724229997Sken io->io_hdr.io_type); 725229997Sken panic("%s: invalid ctl_io type %d\n", __func__, 726229997Sken io->io_hdr.io_type); 727229997Sken break; 728229997Sken } 729229997Sken 730229997Sken return (error_action); 731229997Sken} 732229997Sken 733229997Skenstatic void 734229997Skencfi_init_io(union ctl_io *io, struct cfi_lun *lun, 735229997Sken struct cfi_metatask *metatask, cfi_error_policy policy, int retries, 736229997Sken struct cfi_lun_io *orig_lun_io, 737229997Sken void (*done_function)(union ctl_io *io)) 738229997Sken{ 739229997Sken struct cfi_lun_io *lun_io; 740229997Sken 741229997Sken io->io_hdr.nexus.initid.id = 7; 742229997Sken io->io_hdr.nexus.targ_port = lun->softc->fe.targ_port; 743229997Sken io->io_hdr.nexus.targ_target.id = lun->target_id.id; 744229997Sken io->io_hdr.nexus.targ_lun = lun->lun_id; 745229997Sken io->io_hdr.retries = retries; 746229997Sken lun_io = (struct cfi_lun_io *)io->io_hdr.port_priv; 747229997Sken io->io_hdr.ctl_private[CTL_PRIV_FRONTEND].ptr = lun_io; 748229997Sken lun_io->lun = lun; 749229997Sken lun_io->metatask = metatask; 750229997Sken lun_io->ctl_io = io; 751229997Sken lun_io->policy = policy; 752229997Sken lun_io->orig_lun_io = orig_lun_io; 753229997Sken lun_io->done_function = done_function; 754229997Sken /* 755229997Sken * We only set the tag number for SCSI I/Os. For task management 756229997Sken * commands, the tag number is only really needed for aborts, so 757229997Sken * the caller can set it if necessary. 758229997Sken */ 759229997Sken switch (io->io_hdr.io_type) { 760229997Sken case CTL_IO_SCSI: 761229997Sken io->scsiio.tag_num = lun->cur_tag_num++; 762229997Sken break; 763229997Sken case CTL_IO_TASK: 764229997Sken default: 765229997Sken break; 766229997Sken } 767229997Sken} 768229997Sken 769229997Skenstatic void 770229997Skencfi_done(union ctl_io *io) 771229997Sken{ 772229997Sken struct cfi_lun_io *lun_io; 773229997Sken struct cfi_softc *softc; 774229997Sken struct cfi_lun *lun; 775229997Sken 776229997Sken lun_io = (struct cfi_lun_io *) 777229997Sken io->io_hdr.ctl_private[CTL_PRIV_FRONTEND].ptr; 778229997Sken 779229997Sken lun = lun_io->lun; 780229997Sken softc = lun->softc; 781229997Sken 782229997Sken /* 783229997Sken * Very minimal retry logic. We basically retry if we got an error 784229997Sken * back, and the retry count is greater than 0. If we ever want 785229997Sken * more sophisticated initiator type behavior, the CAM error 786229997Sken * recovery code in ../common might be helpful. 787229997Sken */ 788229997Sken if (((io->io_hdr.status & CTL_STATUS_MASK) != CTL_SUCCESS) 789229997Sken && (io->io_hdr.retries > 0)) { 790229997Sken ctl_io_status old_status; 791229997Sken cfi_error_action error_action; 792229997Sken 793229997Sken error_action = cfi_error_parse(io, lun_io); 794229997Sken 795229997Sken switch (error_action & CFI_ERR_MASK) { 796229997Sken case CFI_ERR_FAIL: 797229997Sken goto done; 798229997Sken break; /* NOTREACHED */ 799229997Sken case CFI_ERR_LUN_RESET: { 800229997Sken union ctl_io *new_io; 801229997Sken struct cfi_lun_io *new_lun_io; 802229997Sken 803229997Sken new_io = ctl_alloc_io(softc->fe.ctl_pool_ref); 804229997Sken if (new_io == NULL) { 805229997Sken printf("%s: unable to allocate ctl_io for " 806229997Sken "error recovery\n", __func__); 807229997Sken goto done; 808229997Sken } 809229997Sken ctl_zero_io(new_io); 810229997Sken 811229997Sken new_io->io_hdr.io_type = CTL_IO_TASK; 812229997Sken new_io->taskio.task_action = CTL_TASK_LUN_RESET; 813229997Sken 814229997Sken cfi_init_io(new_io, 815229997Sken /*lun*/ lun_io->lun, 816229997Sken /*metatask*/ NULL, 817229997Sken /*policy*/ CFI_ERR_SOFT, 818229997Sken /*retries*/ 0, 819229997Sken /*orig_lun_io*/lun_io, 820229997Sken /*done_function*/ cfi_err_recovery_done); 821229997Sken 822229997Sken 823229997Sken new_lun_io = (struct cfi_lun_io *) 824229997Sken new_io->io_hdr.port_priv; 825229997Sken 826229997Sken mtx_lock(&lun->softc->lock); 827229997Sken STAILQ_INSERT_TAIL(&lun->io_list, new_lun_io, links); 828229997Sken mtx_unlock(&lun->softc->lock); 829229997Sken 830229997Sken io = new_io; 831229997Sken break; 832229997Sken } 833229997Sken case CFI_ERR_RETRY: 834229997Sken default: 835229997Sken if ((error_action & CFI_ERR_NO_DECREMENT) == 0) 836229997Sken io->io_hdr.retries--; 837229997Sken break; 838229997Sken } 839229997Sken 840229997Sken old_status = io->io_hdr.status; 841229997Sken io->io_hdr.status = CTL_STATUS_NONE; 842229997Sken#if 0 843229997Sken io->io_hdr.flags &= ~CTL_FLAG_ALREADY_DONE; 844229997Sken#endif 845229997Sken io->io_hdr.flags &= ~CTL_FLAG_ABORT; 846229997Sken io->io_hdr.flags &= ~CTL_FLAG_SENT_2OTHER_SC; 847229997Sken 848229997Sken if (ctl_queue(io) != CTL_RETVAL_COMPLETE) { 849229997Sken printf("%s: error returned from ctl_queue()!\n", 850229997Sken __func__); 851229997Sken io->io_hdr.status = old_status; 852229997Sken } else 853229997Sken return; 854229997Sken } 855229997Skendone: 856229997Sken lun_io->done_function(io); 857229997Sken} 858229997Sken 859229997Skenstatic void 860229997Skencfi_lun_probe_done(union ctl_io *io) 861229997Sken{ 862229997Sken struct cfi_lun *lun; 863229997Sken struct cfi_lun_io *lun_io; 864229997Sken 865229997Sken lun_io = (struct cfi_lun_io *) 866229997Sken io->io_hdr.ctl_private[CTL_PRIV_FRONTEND].ptr; 867229997Sken lun = lun_io->lun; 868229997Sken 869229997Sken switch (lun->state) { 870229997Sken case CFI_LUN_INQUIRY: { 871229997Sken if ((io->io_hdr.status & CTL_STATUS_MASK) != CTL_SUCCESS) { 872229997Sken /* print out something here?? */ 873229997Sken printf("%s: LUN %d probe failed because inquiry " 874229997Sken "failed\n", __func__, lun->lun_id); 875229997Sken ctl_io_error_print(io, NULL); 876229997Sken } else { 877229997Sken 878229997Sken if (SID_TYPE(&lun->inq_data) != T_DIRECT) { 879229997Sken char path_str[40]; 880229997Sken 881229997Sken lun->state = CFI_LUN_READY; 882229997Sken ctl_scsi_path_string(io, path_str, 883229997Sken sizeof(path_str)); 884229997Sken printf("%s", path_str); 885229997Sken scsi_print_inquiry(&lun->inq_data); 886229997Sken } else { 887229997Sken lun->state = CFI_LUN_READCAPACITY; 888229997Sken cfi_lun_probe(lun, /*have_lock*/ 0); 889229997Sken } 890229997Sken } 891229997Sken mtx_lock(&lun->softc->lock); 892229997Sken STAILQ_REMOVE(&lun->io_list, lun_io, cfi_lun_io, links); 893229997Sken mtx_unlock(&lun->softc->lock); 894229997Sken ctl_free_io(io); 895229997Sken break; 896229997Sken } 897229997Sken case CFI_LUN_READCAPACITY: 898229997Sken case CFI_LUN_READCAPACITY_16: { 899229997Sken uint64_t maxlba; 900229997Sken uint32_t blocksize; 901229997Sken 902229997Sken maxlba = 0; 903229997Sken blocksize = 0; 904229997Sken 905229997Sken if ((io->io_hdr.status & CTL_STATUS_MASK) != CTL_SUCCESS) { 906229997Sken printf("%s: LUN %d probe failed because READ CAPACITY " 907229997Sken "failed\n", __func__, lun->lun_id); 908229997Sken ctl_io_error_print(io, NULL); 909229997Sken } else { 910229997Sken 911229997Sken if (lun->state == CFI_LUN_READCAPACITY) { 912229997Sken struct scsi_read_capacity_data *rdcap; 913229997Sken 914229997Sken rdcap = (struct scsi_read_capacity_data *) 915229997Sken io->scsiio.ext_data_ptr; 916229997Sken 917229997Sken maxlba = scsi_4btoul(rdcap->addr); 918229997Sken blocksize = scsi_4btoul(rdcap->length); 919229997Sken if (blocksize == 0) { 920229997Sken printf("%s: LUN %d has invalid " 921229997Sken "blocksize 0, probe aborted\n", 922229997Sken __func__, lun->lun_id); 923229997Sken } else if (maxlba == 0xffffffff) { 924229997Sken lun->state = CFI_LUN_READCAPACITY_16; 925229997Sken cfi_lun_probe(lun, /*have_lock*/ 0); 926229997Sken } else 927229997Sken lun->state = CFI_LUN_READY; 928229997Sken } else { 929229997Sken struct scsi_read_capacity_data_long *rdcap_long; 930229997Sken 931229997Sken rdcap_long = (struct 932229997Sken scsi_read_capacity_data_long *) 933229997Sken io->scsiio.ext_data_ptr; 934229997Sken maxlba = scsi_8btou64(rdcap_long->addr); 935229997Sken blocksize = scsi_4btoul(rdcap_long->length); 936229997Sken 937229997Sken if (blocksize == 0) { 938229997Sken printf("%s: LUN %d has invalid " 939229997Sken "blocksize 0, probe aborted\n", 940229997Sken __func__, lun->lun_id); 941229997Sken } else 942229997Sken lun->state = CFI_LUN_READY; 943229997Sken } 944229997Sken } 945229997Sken 946229997Sken if (lun->state == CFI_LUN_READY) { 947229997Sken char path_str[40]; 948229997Sken 949229997Sken lun->num_blocks = maxlba + 1; 950229997Sken lun->blocksize = blocksize; 951229997Sken 952229997Sken /* 953229997Sken * If this is true, the blocksize is a power of 2. 954229997Sken * We already checked for 0 above. 955229997Sken */ 956229997Sken if (((blocksize - 1) & blocksize) == 0) { 957229997Sken int i; 958229997Sken 959229997Sken for (i = 0; i < 32; i++) { 960229997Sken if ((blocksize & (1 << i)) != 0) { 961229997Sken lun->blocksize_powerof2 = i; 962229997Sken break; 963229997Sken } 964229997Sken } 965229997Sken } 966229997Sken ctl_scsi_path_string(io, path_str,sizeof(path_str)); 967229997Sken printf("%s", path_str); 968229997Sken scsi_print_inquiry(&lun->inq_data); 969229997Sken printf("%s %ju blocks, blocksize %d\n", path_str, 970229997Sken (uintmax_t)maxlba + 1, blocksize); 971229997Sken } 972229997Sken mtx_lock(&lun->softc->lock); 973229997Sken STAILQ_REMOVE(&lun->io_list, lun_io, cfi_lun_io, links); 974229997Sken mtx_unlock(&lun->softc->lock); 975229997Sken free(io->scsiio.ext_data_ptr, M_CTL_CFI); 976229997Sken ctl_free_io(io); 977229997Sken break; 978229997Sken } 979229997Sken case CFI_LUN_READY: 980229997Sken default: 981229997Sken mtx_lock(&lun->softc->lock); 982229997Sken /* How did we get here?? */ 983229997Sken STAILQ_REMOVE(&lun->io_list, lun_io, cfi_lun_io, links); 984229997Sken mtx_unlock(&lun->softc->lock); 985229997Sken ctl_free_io(io); 986229997Sken break; 987229997Sken } 988229997Sken} 989229997Sken 990229997Skenstatic void 991229997Skencfi_lun_probe(struct cfi_lun *lun, int have_lock) 992229997Sken{ 993229997Sken 994229997Sken if (have_lock == 0) 995229997Sken mtx_lock(&lun->softc->lock); 996229997Sken if ((lun->softc->flags & CFI_ONLINE) == 0) { 997229997Sken if (have_lock == 0) 998229997Sken mtx_unlock(&lun->softc->lock); 999229997Sken return; 1000229997Sken } 1001229997Sken if (have_lock == 0) 1002229997Sken mtx_unlock(&lun->softc->lock); 1003229997Sken 1004229997Sken switch (lun->state) { 1005229997Sken case CFI_LUN_INQUIRY: { 1006229997Sken struct cfi_lun_io *lun_io; 1007229997Sken union ctl_io *io; 1008229997Sken 1009229997Sken io = ctl_alloc_io(lun->softc->fe.ctl_pool_ref); 1010229997Sken if (io == NULL) { 1011229997Sken printf("%s: unable to alloc ctl_io for target %ju " 1012229997Sken "lun %d probe\n", __func__, 1013229997Sken (uintmax_t)lun->target_id.id, lun->lun_id); 1014229997Sken return; 1015229997Sken } 1016229997Sken ctl_scsi_inquiry(io, 1017229997Sken /*data_ptr*/(uint8_t *)&lun->inq_data, 1018229997Sken /*data_len*/ sizeof(lun->inq_data), 1019229997Sken /*byte2*/ 0, 1020229997Sken /*page_code*/ 0, 1021229997Sken /*tag_type*/ CTL_TAG_SIMPLE, 1022229997Sken /*control*/ 0); 1023229997Sken 1024229997Sken cfi_init_io(io, 1025229997Sken /*lun*/ lun, 1026229997Sken /*metatask*/ NULL, 1027229997Sken /*policy*/ CFI_ERR_SOFT, 1028229997Sken /*retries*/ 5, 1029229997Sken /*orig_lun_io*/ NULL, 1030229997Sken /*done_function*/ 1031229997Sken cfi_lun_probe_done); 1032229997Sken 1033229997Sken lun_io = (struct cfi_lun_io *)io->io_hdr.port_priv; 1034229997Sken 1035229997Sken if (have_lock == 0) 1036229997Sken mtx_lock(&lun->softc->lock); 1037229997Sken STAILQ_INSERT_TAIL(&lun->io_list, lun_io, links); 1038229997Sken if (have_lock == 0) 1039229997Sken mtx_unlock(&lun->softc->lock); 1040229997Sken 1041229997Sken if (ctl_queue(io) != CTL_RETVAL_COMPLETE) { 1042229997Sken printf("%s: error returned from ctl_queue()!\n", 1043229997Sken __func__); 1044229997Sken STAILQ_REMOVE(&lun->io_list, lun_io, 1045229997Sken cfi_lun_io, links); 1046229997Sken ctl_free_io(io); 1047229997Sken } 1048229997Sken break; 1049229997Sken } 1050229997Sken case CFI_LUN_READCAPACITY: 1051229997Sken case CFI_LUN_READCAPACITY_16: { 1052229997Sken struct cfi_lun_io *lun_io; 1053229997Sken uint8_t *dataptr; 1054229997Sken union ctl_io *io; 1055229997Sken 1056229997Sken io = ctl_alloc_io(lun->softc->fe.ctl_pool_ref); 1057229997Sken if (io == NULL) { 1058229997Sken printf("%s: unable to alloc ctl_io for target %ju " 1059229997Sken "lun %d probe\n", __func__, 1060229997Sken (uintmax_t)lun->target_id.id, lun->lun_id); 1061229997Sken return; 1062229997Sken } 1063229997Sken 1064229997Sken dataptr = malloc(sizeof(struct scsi_read_capacity_data_long), 1065229997Sken M_CTL_CFI, M_NOWAIT); 1066229997Sken if (dataptr == NULL) { 1067229997Sken printf("%s: unable to allocate SCSI read capacity " 1068229997Sken "buffer for target %ju lun %d\n", __func__, 1069229997Sken (uintmax_t)lun->target_id.id, lun->lun_id); 1070229997Sken return; 1071229997Sken } 1072229997Sken if (lun->state == CFI_LUN_READCAPACITY) { 1073229997Sken ctl_scsi_read_capacity(io, 1074229997Sken /*data_ptr*/ dataptr, 1075229997Sken /*data_len*/ 1076229997Sken sizeof(struct scsi_read_capacity_data_long), 1077229997Sken /*addr*/ 0, 1078229997Sken /*reladr*/ 0, 1079229997Sken /*pmi*/ 0, 1080229997Sken /*tag_type*/ CTL_TAG_SIMPLE, 1081229997Sken /*control*/ 0); 1082229997Sken } else { 1083229997Sken ctl_scsi_read_capacity_16(io, 1084229997Sken /*data_ptr*/ dataptr, 1085229997Sken /*data_len*/ 1086229997Sken sizeof(struct scsi_read_capacity_data_long), 1087229997Sken /*addr*/ 0, 1088229997Sken /*reladr*/ 0, 1089229997Sken /*pmi*/ 0, 1090229997Sken /*tag_type*/ CTL_TAG_SIMPLE, 1091229997Sken /*control*/ 0); 1092229997Sken } 1093229997Sken cfi_init_io(io, 1094229997Sken /*lun*/ lun, 1095229997Sken /*metatask*/ NULL, 1096229997Sken /*policy*/ CFI_ERR_SOFT, 1097229997Sken /*retries*/ 7, 1098229997Sken /*orig_lun_io*/ NULL, 1099229997Sken /*done_function*/ cfi_lun_probe_done); 1100229997Sken 1101229997Sken lun_io = (struct cfi_lun_io *)io->io_hdr.port_priv; 1102229997Sken 1103229997Sken if (have_lock == 0) 1104229997Sken mtx_lock(&lun->softc->lock); 1105229997Sken STAILQ_INSERT_TAIL(&lun->io_list, lun_io, links); 1106229997Sken if (have_lock == 0) 1107229997Sken mtx_unlock(&lun->softc->lock); 1108229997Sken 1109229997Sken if (ctl_queue(io) != CTL_RETVAL_COMPLETE) { 1110229997Sken printf("%s: error returned from ctl_queue()!\n", 1111229997Sken __func__); 1112229997Sken STAILQ_REMOVE(&lun->io_list, lun_io, 1113229997Sken cfi_lun_io, links); 1114229997Sken free(dataptr, M_CTL_CFI); 1115229997Sken ctl_free_io(io); 1116229997Sken } 1117229997Sken break; 1118229997Sken } 1119229997Sken case CFI_LUN_READY: 1120229997Sken default: 1121229997Sken /* Why were we called? */ 1122229997Sken break; 1123229997Sken } 1124229997Sken} 1125229997Sken 1126229997Skenstatic void 1127229997Skencfi_metatask_done(struct cfi_softc *softc, struct cfi_metatask *metatask) 1128229997Sken{ 1129229997Sken mtx_lock(&softc->lock); 1130229997Sken STAILQ_REMOVE(&softc->metatask_list, metatask, cfi_metatask, links); 1131229997Sken mtx_unlock(&softc->lock); 1132229997Sken 1133229997Sken /* 1134229997Sken * Return status to the caller. Caller allocated storage, and is 1135229997Sken * responsible for calling cfi_free_metatask to release it once 1136229997Sken * they've seen the status. 1137229997Sken */ 1138229997Sken metatask->callback(metatask->callback_arg, metatask); 1139229997Sken} 1140229997Sken 1141229997Skenstatic void 1142229997Skencfi_metatask_bbr_errorparse(struct cfi_metatask *metatask, union ctl_io *io) 1143229997Sken{ 1144229997Sken int error_code, sense_key, asc, ascq; 1145229997Sken 1146229997Sken if (metatask->tasktype != CFI_TASK_BBRREAD) 1147229997Sken return; 1148229997Sken 1149229997Sken if ((io->io_hdr.status & CTL_STATUS_MASK) == CTL_SUCCESS) { 1150229997Sken metatask->status = CFI_MT_SUCCESS; 1151229997Sken metatask->taskinfo.bbrread.status = CFI_BBR_SUCCESS; 1152229997Sken return; 1153229997Sken } 1154229997Sken 1155229997Sken if ((io->io_hdr.status & CTL_STATUS_MASK) != CTL_SCSI_ERROR) { 1156229997Sken metatask->status = CFI_MT_ERROR; 1157229997Sken metatask->taskinfo.bbrread.status = CFI_BBR_ERROR; 1158229997Sken return; 1159229997Sken } 1160229997Sken 1161229997Sken metatask->taskinfo.bbrread.scsi_status = io->scsiio.scsi_status; 1162229997Sken memcpy(&metatask->taskinfo.bbrread.sense_data, &io->scsiio.sense_data, 1163229997Sken ctl_min(sizeof(metatask->taskinfo.bbrread.sense_data), 1164229997Sken sizeof(io->scsiio.sense_data))); 1165229997Sken 1166229997Sken if (io->scsiio.scsi_status == SCSI_STATUS_RESERV_CONFLICT) { 1167229997Sken metatask->status = CFI_MT_ERROR; 1168229997Sken metatask->taskinfo.bbrread.status = CFI_BBR_RESERV_CONFLICT; 1169229997Sken return; 1170229997Sken } 1171229997Sken 1172229997Sken if (io->scsiio.scsi_status != SCSI_STATUS_CHECK_COND) { 1173229997Sken metatask->status = CFI_MT_ERROR; 1174229997Sken metatask->taskinfo.bbrread.status = CFI_BBR_SCSI_ERROR; 1175229997Sken return; 1176229997Sken } 1177229997Sken 1178229997Sken scsi_extract_sense_len(&io->scsiio.sense_data, 1179229997Sken io->scsiio.sense_len, 1180229997Sken &error_code, 1181229997Sken &sense_key, 1182229997Sken &asc, 1183229997Sken &ascq, 1184229997Sken /*show_errors*/ 1); 1185229997Sken 1186229997Sken switch (error_code) { 1187229997Sken case SSD_DEFERRED_ERROR: 1188229997Sken case SSD_DESC_DEFERRED_ERROR: 1189229997Sken metatask->status = CFI_MT_ERROR; 1190229997Sken metatask->taskinfo.bbrread.status = CFI_BBR_SCSI_ERROR; 1191229997Sken break; 1192229997Sken case SSD_CURRENT_ERROR: 1193229997Sken case SSD_DESC_CURRENT_ERROR: 1194229997Sken default: { 1195229997Sken struct scsi_sense_data *sense; 1196229997Sken 1197229997Sken sense = &io->scsiio.sense_data; 1198229997Sken 1199229997Sken if ((asc == 0x04) && (ascq == 0x02)) { 1200229997Sken metatask->status = CFI_MT_ERROR; 1201229997Sken metatask->taskinfo.bbrread.status = CFI_BBR_LUN_STOPPED; 1202229997Sken } else if ((asc == 0x04) && (ascq == 0x03)) { 1203229997Sken metatask->status = CFI_MT_ERROR; 1204229997Sken metatask->taskinfo.bbrread.status = 1205229997Sken CFI_BBR_LUN_OFFLINE_CTL; 1206229997Sken } else if ((asc == 0x44) && (ascq == 0x00)) { 1207229997Sken#ifdef NEEDTOPORT 1208229997Sken if (sense->sense_key_spec[0] & SSD_SCS_VALID) { 1209229997Sken uint16_t retry_count; 1210229997Sken 1211229997Sken retry_count = sense->sense_key_spec[1] << 8 | 1212229997Sken sense->sense_key_spec[2]; 1213229997Sken if (((retry_count & 0xf000) == CSC_RAIDCORE) 1214229997Sken && ((retry_count & 0x0f00) == CSC_SHELF_SW) 1215229997Sken && ((retry_count & 0xff) == 1216229997Sken RC_STS_DEVICE_OFFLINE)) { 1217229997Sken metatask->status = CFI_MT_ERROR; 1218229997Sken metatask->taskinfo.bbrread.status = 1219229997Sken CFI_BBR_LUN_OFFLINE_RC; 1220229997Sken } else { 1221229997Sken metatask->status = CFI_MT_ERROR; 1222229997Sken metatask->taskinfo.bbrread.status = 1223229997Sken CFI_BBR_SCSI_ERROR; 1224229997Sken } 1225229997Sken } else { 1226229997Sken#endif /* NEEDTOPORT */ 1227229997Sken metatask->status = CFI_MT_ERROR; 1228229997Sken metatask->taskinfo.bbrread.status = 1229229997Sken CFI_BBR_SCSI_ERROR; 1230229997Sken#ifdef NEEDTOPORT 1231229997Sken } 1232229997Sken#endif 1233229997Sken } else { 1234229997Sken metatask->status = CFI_MT_ERROR; 1235229997Sken metatask->taskinfo.bbrread.status = CFI_BBR_SCSI_ERROR; 1236229997Sken } 1237229997Sken break; 1238229997Sken } 1239229997Sken } 1240229997Sken} 1241229997Sken 1242229997Skenstatic void 1243229997Skencfi_metatask_io_done(union ctl_io *io) 1244229997Sken{ 1245229997Sken struct cfi_lun_io *lun_io; 1246229997Sken struct cfi_metatask *metatask; 1247229997Sken struct cfi_softc *softc; 1248229997Sken struct cfi_lun *lun; 1249229997Sken 1250229997Sken lun_io = (struct cfi_lun_io *) 1251229997Sken io->io_hdr.ctl_private[CTL_PRIV_FRONTEND].ptr; 1252229997Sken 1253229997Sken lun = lun_io->lun; 1254229997Sken softc = lun->softc; 1255229997Sken 1256229997Sken metatask = lun_io->metatask; 1257229997Sken 1258229997Sken switch (metatask->tasktype) { 1259229997Sken case CFI_TASK_STARTUP: 1260229997Sken case CFI_TASK_SHUTDOWN: { 1261229997Sken int failed, done, is_start; 1262229997Sken 1263229997Sken failed = 0; 1264229997Sken done = 0; 1265229997Sken if (metatask->tasktype == CFI_TASK_STARTUP) 1266229997Sken is_start = 1; 1267229997Sken else 1268229997Sken is_start = 0; 1269229997Sken 1270229997Sken mtx_lock(&softc->lock); 1271229997Sken if ((io->io_hdr.status & CTL_STATUS_MASK) == CTL_SUCCESS) 1272229997Sken metatask->taskinfo.startstop.luns_complete++; 1273229997Sken else { 1274229997Sken metatask->taskinfo.startstop.luns_failed++; 1275229997Sken failed = 1; 1276229997Sken } 1277229997Sken if ((metatask->taskinfo.startstop.luns_complete + 1278229997Sken metatask->taskinfo.startstop.luns_failed) >= 1279229997Sken metatask->taskinfo.startstop.total_luns) 1280229997Sken done = 1; 1281229997Sken 1282229997Sken mtx_unlock(&softc->lock); 1283229997Sken 1284229997Sken if (failed != 0) { 1285229997Sken printf("%s: LUN %d %s request failed\n", __func__, 1286229997Sken lun_io->lun->lun_id, (is_start == 1) ? "start" : 1287229997Sken "stop"); 1288229997Sken ctl_io_error_print(io, &lun_io->lun->inq_data); 1289229997Sken } 1290229997Sken if (done != 0) { 1291229997Sken if (metatask->taskinfo.startstop.luns_failed > 0) 1292229997Sken metatask->status = CFI_MT_ERROR; 1293229997Sken else 1294229997Sken metatask->status = CFI_MT_SUCCESS; 1295229997Sken cfi_metatask_done(softc, metatask); 1296229997Sken } 1297229997Sken mtx_lock(&softc->lock); 1298229997Sken STAILQ_REMOVE(&lun->io_list, lun_io, cfi_lun_io, links); 1299229997Sken mtx_unlock(&softc->lock); 1300229997Sken 1301229997Sken ctl_free_io(io); 1302229997Sken break; 1303229997Sken } 1304229997Sken case CFI_TASK_BBRREAD: { 1305229997Sken /* 1306229997Sken * Translate the SCSI error into an enumeration. 1307229997Sken */ 1308229997Sken cfi_metatask_bbr_errorparse(metatask, io); 1309229997Sken 1310229997Sken mtx_lock(&softc->lock); 1311229997Sken STAILQ_REMOVE(&lun->io_list, lun_io, cfi_lun_io, links); 1312229997Sken mtx_unlock(&softc->lock); 1313229997Sken 1314229997Sken ctl_free_io(io); 1315229997Sken 1316229997Sken cfi_metatask_done(softc, metatask); 1317229997Sken break; 1318229997Sken } 1319229997Sken default: 1320229997Sken /* 1321229997Sken * This shouldn't happen. 1322229997Sken */ 1323229997Sken mtx_lock(&softc->lock); 1324229997Sken STAILQ_REMOVE(&lun->io_list, lun_io, cfi_lun_io, links); 1325229997Sken mtx_unlock(&softc->lock); 1326229997Sken 1327229997Sken ctl_free_io(io); 1328229997Sken break; 1329229997Sken } 1330229997Sken} 1331229997Sken 1332229997Skenstatic void 1333229997Skencfi_err_recovery_done(union ctl_io *io) 1334229997Sken{ 1335229997Sken struct cfi_lun_io *lun_io, *orig_lun_io; 1336229997Sken struct cfi_lun *lun; 1337229997Sken union ctl_io *orig_io; 1338229997Sken 1339229997Sken lun_io = (struct cfi_lun_io *)io->io_hdr.port_priv; 1340229997Sken orig_lun_io = lun_io->orig_lun_io; 1341229997Sken orig_io = orig_lun_io->ctl_io; 1342229997Sken lun = lun_io->lun; 1343229997Sken 1344229997Sken if (io->io_hdr.status != CTL_SUCCESS) { 1345229997Sken printf("%s: error recovery action failed. Original " 1346229997Sken "error:\n", __func__); 1347229997Sken 1348229997Sken ctl_io_error_print(orig_lun_io->ctl_io, &lun->inq_data); 1349229997Sken 1350229997Sken printf("%s: error from error recovery action:\n", __func__); 1351229997Sken 1352229997Sken ctl_io_error_print(io, &lun->inq_data); 1353229997Sken 1354229997Sken printf("%s: trying original command again...\n", __func__); 1355229997Sken } 1356229997Sken 1357229997Sken mtx_lock(&lun->softc->lock); 1358229997Sken STAILQ_REMOVE(&lun->io_list, lun_io, cfi_lun_io, links); 1359229997Sken mtx_unlock(&lun->softc->lock); 1360229997Sken ctl_free_io(io); 1361229997Sken 1362229997Sken orig_io->io_hdr.retries--; 1363229997Sken orig_io->io_hdr.status = CTL_STATUS_NONE; 1364229997Sken 1365229997Sken if (ctl_queue(orig_io) != CTL_RETVAL_COMPLETE) { 1366229997Sken printf("%s: error returned from ctl_queue()!\n", __func__); 1367229997Sken STAILQ_REMOVE(&lun->io_list, orig_lun_io, 1368229997Sken cfi_lun_io, links); 1369229997Sken ctl_free_io(orig_io); 1370229997Sken } 1371229997Sken} 1372229997Sken 1373229997Skenstatic void 1374229997Skencfi_lun_io_done(union ctl_io *io) 1375229997Sken{ 1376229997Sken struct cfi_lun *lun; 1377229997Sken struct cfi_lun_io *lun_io; 1378229997Sken 1379229997Sken lun_io = (struct cfi_lun_io *) 1380229997Sken io->io_hdr.ctl_private[CTL_PRIV_FRONTEND].ptr; 1381229997Sken lun = lun_io->lun; 1382229997Sken 1383229997Sken if (lun_io->metatask == NULL) { 1384229997Sken printf("%s: I/O has no metatask pointer, discarding\n", 1385229997Sken __func__); 1386229997Sken STAILQ_REMOVE(&lun->io_list, lun_io, cfi_lun_io, links); 1387229997Sken ctl_free_io(io); 1388229997Sken return; 1389229997Sken } 1390229997Sken cfi_metatask_io_done(io); 1391229997Sken} 1392229997Sken 1393229997Skenvoid 1394229997Skencfi_action(struct cfi_metatask *metatask) 1395229997Sken{ 1396229997Sken struct cfi_softc *softc; 1397229997Sken 1398229997Sken softc = &fetd_internal_softc; 1399229997Sken 1400229997Sken mtx_lock(&softc->lock); 1401229997Sken 1402229997Sken STAILQ_INSERT_TAIL(&softc->metatask_list, metatask, links); 1403229997Sken 1404229997Sken if ((softc->flags & CFI_ONLINE) == 0) { 1405229997Sken mtx_unlock(&softc->lock); 1406229997Sken metatask->status = CFI_MT_PORT_OFFLINE; 1407229997Sken cfi_metatask_done(softc, metatask); 1408229997Sken return; 1409229997Sken } else 1410229997Sken mtx_unlock(&softc->lock); 1411229997Sken 1412229997Sken switch (metatask->tasktype) { 1413229997Sken case CFI_TASK_STARTUP: 1414229997Sken case CFI_TASK_SHUTDOWN: { 1415229997Sken union ctl_io *io; 1416229997Sken int da_luns, ios_allocated, do_start; 1417229997Sken struct cfi_lun *lun; 1418229997Sken STAILQ_HEAD(, ctl_io_hdr) tmp_io_list; 1419229997Sken 1420229997Sken da_luns = 0; 1421229997Sken ios_allocated = 0; 1422229997Sken STAILQ_INIT(&tmp_io_list); 1423229997Sken 1424229997Sken if (metatask->tasktype == CFI_TASK_STARTUP) 1425229997Sken do_start = 1; 1426229997Sken else 1427229997Sken do_start = 0; 1428229997Sken 1429229997Sken mtx_lock(&softc->lock); 1430229997Sken STAILQ_FOREACH(lun, &softc->lun_list, links) { 1431229997Sken if (lun->state != CFI_LUN_READY) 1432229997Sken continue; 1433229997Sken 1434229997Sken if (SID_TYPE(&lun->inq_data) != T_DIRECT) 1435229997Sken continue; 1436229997Sken da_luns++; 1437229997Sken io = ctl_alloc_io(softc->fe.ctl_pool_ref); 1438229997Sken if (io != NULL) { 1439229997Sken ios_allocated++; 1440229997Sken STAILQ_INSERT_TAIL(&tmp_io_list, &io->io_hdr, 1441229997Sken links); 1442229997Sken } 1443229997Sken } 1444229997Sken 1445229997Sken if (ios_allocated < da_luns) { 1446229997Sken printf("%s: error allocating ctl_io for %s\n", 1447229997Sken __func__, (do_start == 1) ? "startup" : 1448229997Sken "shutdown"); 1449229997Sken da_luns = ios_allocated; 1450229997Sken } 1451229997Sken 1452229997Sken metatask->taskinfo.startstop.total_luns = da_luns; 1453229997Sken 1454229997Sken STAILQ_FOREACH(lun, &softc->lun_list, links) { 1455229997Sken struct cfi_lun_io *lun_io; 1456229997Sken 1457229997Sken if (lun->state != CFI_LUN_READY) 1458229997Sken continue; 1459229997Sken 1460229997Sken if (SID_TYPE(&lun->inq_data) != T_DIRECT) 1461229997Sken continue; 1462229997Sken 1463229997Sken io = (union ctl_io *)STAILQ_FIRST(&tmp_io_list); 1464229997Sken if (io == NULL) 1465229997Sken break; 1466229997Sken 1467229997Sken STAILQ_REMOVE(&tmp_io_list, &io->io_hdr, ctl_io_hdr, 1468229997Sken links); 1469229997Sken 1470229997Sken ctl_scsi_start_stop(io, 1471229997Sken /*start*/ do_start, 1472229997Sken /*load_eject*/ 0, 1473229997Sken /*immediate*/ 0, 1474229997Sken /*power_conditions*/ 1475229997Sken SSS_PC_START_VALID, 1476229997Sken /*onoffline*/ 1, 1477229997Sken /*ctl_tag_type*/ CTL_TAG_ORDERED, 1478229997Sken /*control*/ 0); 1479229997Sken 1480229997Sken cfi_init_io(io, 1481229997Sken /*lun*/ lun, 1482229997Sken /*metatask*/ metatask, 1483229997Sken /*policy*/ CFI_ERR_HARD, 1484229997Sken /*retries*/ 3, 1485229997Sken /*orig_lun_io*/ NULL, 1486229997Sken /*done_function*/ cfi_lun_io_done); 1487229997Sken 1488229997Sken lun_io = (struct cfi_lun_io *) io->io_hdr.port_priv; 1489229997Sken 1490229997Sken STAILQ_INSERT_TAIL(&lun->io_list, lun_io, links); 1491229997Sken 1492229997Sken if (ctl_queue(io) != CTL_RETVAL_COMPLETE) { 1493229997Sken printf("%s: error returned from ctl_queue()!\n", 1494229997Sken __func__); 1495229997Sken STAILQ_REMOVE(&lun->io_list, lun_io, 1496229997Sken cfi_lun_io, links); 1497229997Sken ctl_free_io(io); 1498229997Sken metatask->taskinfo.startstop.total_luns--; 1499229997Sken } 1500229997Sken } 1501229997Sken 1502229997Sken if (STAILQ_FIRST(&tmp_io_list) != NULL) { 1503229997Sken printf("%s: error: tmp_io_list != NULL\n", __func__); 1504229997Sken for (io = (union ctl_io *)STAILQ_FIRST(&tmp_io_list); 1505229997Sken io != NULL; 1506229997Sken io = (union ctl_io *)STAILQ_FIRST(&tmp_io_list)) { 1507229997Sken STAILQ_REMOVE(&tmp_io_list, &io->io_hdr, 1508229997Sken ctl_io_hdr, links); 1509229997Sken ctl_free_io(io); 1510229997Sken } 1511229997Sken } 1512229997Sken mtx_unlock(&softc->lock); 1513229997Sken 1514229997Sken break; 1515229997Sken } 1516229997Sken case CFI_TASK_BBRREAD: { 1517229997Sken union ctl_io *io; 1518229997Sken struct cfi_lun *lun; 1519229997Sken struct cfi_lun_io *lun_io; 1520229997Sken cfi_bbrread_status status; 1521229997Sken int req_lun_num; 1522229997Sken uint32_t num_blocks; 1523229997Sken 1524229997Sken status = CFI_BBR_SUCCESS; 1525229997Sken 1526229997Sken req_lun_num = metatask->taskinfo.bbrread.lun_num; 1527229997Sken 1528229997Sken mtx_lock(&softc->lock); 1529229997Sken STAILQ_FOREACH(lun, &softc->lun_list, links) { 1530229997Sken if (lun->lun_id != req_lun_num) 1531229997Sken continue; 1532229997Sken if (lun->state != CFI_LUN_READY) { 1533229997Sken status = CFI_BBR_LUN_UNCONFIG; 1534229997Sken break; 1535229997Sken } else 1536229997Sken break; 1537229997Sken } 1538229997Sken 1539229997Sken if (lun == NULL) 1540229997Sken status = CFI_BBR_NO_LUN; 1541229997Sken 1542229997Sken if (status != CFI_BBR_SUCCESS) { 1543229997Sken metatask->status = CFI_MT_ERROR; 1544229997Sken metatask->taskinfo.bbrread.status = status; 1545229997Sken mtx_unlock(&softc->lock); 1546229997Sken cfi_metatask_done(softc, metatask); 1547229997Sken break; 1548229997Sken } 1549229997Sken 1550229997Sken /* 1551229997Sken * Convert the number of bytes given into blocks and check 1552229997Sken * that the number of bytes is a multiple of the blocksize. 1553229997Sken * CTL will verify that the LBA is okay. 1554229997Sken */ 1555229997Sken if (lun->blocksize_powerof2 != 0) { 1556229997Sken if ((metatask->taskinfo.bbrread.len & 1557229997Sken (lun->blocksize - 1)) != 0) { 1558229997Sken metatask->status = CFI_MT_ERROR; 1559229997Sken metatask->taskinfo.bbrread.status = 1560229997Sken CFI_BBR_BAD_LEN; 1561229997Sken cfi_metatask_done(softc, metatask); 1562229997Sken break; 1563229997Sken } 1564229997Sken 1565229997Sken num_blocks = metatask->taskinfo.bbrread.len >> 1566229997Sken lun->blocksize_powerof2; 1567229997Sken } else { 1568229997Sken /* 1569229997Sken * XXX KDM this could result in floating point 1570229997Sken * division, which isn't supported in the kernel on 1571229997Sken * x86 at least. 1572229997Sken */ 1573229997Sken if ((metatask->taskinfo.bbrread.len % 1574229997Sken lun->blocksize) != 0) { 1575229997Sken metatask->status = CFI_MT_ERROR; 1576229997Sken metatask->taskinfo.bbrread.status = 1577229997Sken CFI_BBR_BAD_LEN; 1578229997Sken cfi_metatask_done(softc, metatask); 1579229997Sken break; 1580229997Sken } 1581229997Sken 1582229997Sken /* 1583229997Sken * XXX KDM this could result in floating point 1584229997Sken * division in some cases. 1585229997Sken */ 1586229997Sken num_blocks = metatask->taskinfo.bbrread.len / 1587229997Sken lun->blocksize; 1588229997Sken 1589229997Sken } 1590229997Sken 1591229997Sken io = ctl_alloc_io(softc->fe.ctl_pool_ref); 1592229997Sken if (io == NULL) { 1593229997Sken metatask->status = CFI_MT_ERROR; 1594229997Sken metatask->taskinfo.bbrread.status = CFI_BBR_NO_MEM; 1595229997Sken mtx_unlock(&softc->lock); 1596229997Sken cfi_metatask_done(softc, metatask); 1597229997Sken break; 1598229997Sken } 1599229997Sken 1600229997Sken /* 1601229997Sken * XXX KDM need to do a read capacity to get the blocksize 1602229997Sken * for this device. 1603229997Sken */ 1604229997Sken ctl_scsi_read_write(io, 1605229997Sken /*data_ptr*/ NULL, 1606229997Sken /*data_len*/ metatask->taskinfo.bbrread.len, 1607229997Sken /*read_op*/ 1, 1608229997Sken /*byte2*/ 0, 1609229997Sken /*minimum_cdb_size*/ 0, 1610229997Sken /*lba*/ metatask->taskinfo.bbrread.lba, 1611229997Sken /*num_blocks*/ num_blocks, 1612229997Sken /*tag_type*/ CTL_TAG_SIMPLE, 1613229997Sken /*control*/ 0); 1614229997Sken 1615229997Sken cfi_init_io(io, 1616229997Sken /*lun*/ lun, 1617229997Sken /*metatask*/ metatask, 1618229997Sken /*policy*/ CFI_ERR_SOFT, 1619229997Sken /*retries*/ 3, 1620229997Sken /*orig_lun_io*/ NULL, 1621229997Sken /*done_function*/ cfi_lun_io_done); 1622229997Sken 1623229997Sken lun_io = (struct cfi_lun_io *)io->io_hdr.port_priv; 1624229997Sken 1625229997Sken STAILQ_INSERT_TAIL(&lun->io_list, lun_io, links); 1626229997Sken 1627229997Sken if (ctl_queue(io) != CTL_RETVAL_COMPLETE) { 1628229997Sken printf("%s: error returned from ctl_queue()!\n", 1629229997Sken __func__); 1630229997Sken STAILQ_REMOVE(&lun->io_list, lun_io, cfi_lun_io, links); 1631229997Sken ctl_free_io(io); 1632229997Sken metatask->status = CFI_MT_ERROR; 1633229997Sken metatask->taskinfo.bbrread.status = CFI_BBR_ERROR; 1634229997Sken mtx_unlock(&softc->lock); 1635229997Sken cfi_metatask_done(softc, metatask); 1636229997Sken break; 1637229997Sken } 1638229997Sken 1639229997Sken mtx_unlock(&softc->lock); 1640229997Sken break; 1641229997Sken } 1642229997Sken default: 1643229997Sken panic("invalid metatask type %d", metatask->tasktype); 1644229997Sken break; /* NOTREACHED */ 1645229997Sken } 1646229997Sken} 1647229997Sken 1648229997Skenstruct cfi_metatask * 1649229997Skencfi_alloc_metatask(int can_wait) 1650229997Sken{ 1651229997Sken struct cfi_metatask *metatask; 1652229997Sken struct cfi_softc *softc; 1653229997Sken 1654229997Sken softc = &fetd_internal_softc; 1655229997Sken 1656265654Smav metatask = uma_zalloc(cfi_metatask_zone, 1657265654Smav (can_wait ? M_WAITOK : M_NOWAIT) | M_ZERO); 1658265654Smav if (metatask == NULL) 1659229997Sken return (NULL); 1660229997Sken 1661229997Sken metatask->status = CFI_MT_NONE; 1662229997Sken 1663229997Sken return (metatask); 1664229997Sken} 1665229997Sken 1666229997Skenvoid 1667229997Skencfi_free_metatask(struct cfi_metatask *metatask) 1668229997Sken{ 1669265654Smav 1670265654Smav uma_zfree(cfi_metatask_zone, metatask); 1671229997Sken} 1672229997Sken 1673229997Sken/* 1674229997Sken * vim: ts=8 1675229997Sken */ 1676