static void ips_read_nvram_callback(void *cmdptr, bus_dma_segment_t *segments,int segnum, int error) { ips_softc_t *sc; ips_command_t *command = cmdptr; ips_rw_nvram_cmd *command_struct; sc = command->sc; if(error){ ips_cmd_status_t * status = command->arg; status->value = IPS_ERROR_STATUS; ips_insert_free_cmd(sc, command); printf("ips: error = %d in ips_read_nvram_callback\n", error); return; } command_struct = (ips_rw_nvram_cmd *)command->command_buffer; command_struct->command = IPS_RW_NVRAM_CMD; command_struct->id = command->id; command_struct->pagenum = 5; command_struct->rw = 0; command_struct->buffaddr = segments[0].ds_addr; bus_dmamap_sync(sc->command_dmatag, command->command_dmamap, BUS_DMASYNC_PREWRITE); bus_dmamap_sync(command->data_dmatag, command->data_dmamap, BUS_DMASYNC_PREREAD); sc->ips_issue_cmd(command); }
static int ips_ioctl_cmd(ips_softc_t *sc, ips_ioctl_t *ioctl_cmd, ips_user_request *user_request) { ips_command_t *command; int error = EINVAL; if (bus_dma_tag_create( /* parent */ sc->adapter_dmatag, /* alignment */ 1, /* boundary */ 0, /* lowaddr */ BUS_SPACE_MAXADDR_32BIT, /* highaddr */ BUS_SPACE_MAXADDR, /* filter */ NULL, /* filterarg */ NULL, /* maxsize */ ioctl_cmd->datasize, /* numsegs */ 1, /* maxsegsize*/ ioctl_cmd->datasize, /* flags */ 0, /* lockfunc */ NULL, /* lockarg */ NULL, &ioctl_cmd->dmatag) != 0) { return ENOMEM; } if(bus_dmamem_alloc(ioctl_cmd->dmatag, &ioctl_cmd->data_buffer, 0, &ioctl_cmd->dmamap)){ error = ENOMEM; goto exit; } if(copyin(user_request->data_buffer,ioctl_cmd->data_buffer, ioctl_cmd->datasize)) goto exit; ioctl_cmd->status.value = 0xffffffff; mtx_lock(&sc->queue_mtx); if((error = ips_get_free_cmd(sc, &command, 0)) > 0){ error = ENOMEM; mtx_unlock(&sc->queue_mtx); goto exit; } command->arg = ioctl_cmd; ips_ioctl_start(command); while( ioctl_cmd->status.value == 0xffffffff) msleep(ioctl_cmd, &sc->queue_mtx, 0, "ips", hz/10); if(COMMAND_ERROR(ioctl_cmd)) error = EIO; else error = 0; mtx_unlock(&sc->queue_mtx); if(copyout(ioctl_cmd->data_buffer, user_request->data_buffer, ioctl_cmd->datasize)) error = EINVAL; mtx_lock(&sc->queue_mtx); ips_insert_free_cmd(sc, command); mtx_unlock(&sc->queue_mtx); exit: bus_dmamem_free(ioctl_cmd->dmatag, ioctl_cmd->data_buffer, ioctl_cmd->dmamap); bus_dma_tag_destroy(ioctl_cmd->dmatag); return error; }
static int ips_send_drive_info_cmd(ips_command_t *command) { int error = 0; ips_softc_t *sc = command->sc; ips_cmd_status_t *status = command->arg; ips_drive_info_t *driveinfo; if (bus_dma_tag_create( /* parent */ sc->adapter_dmatag, /* alignemnt */ 1, /* boundary */ 0, /* lowaddr */ BUS_SPACE_MAXADDR_32BIT, /* highaddr */ BUS_SPACE_MAXADDR, /* filter */ NULL, /* filterarg */ NULL, /* maxsize */ IPS_DRIVE_INFO_LEN, /* numsegs */ 1, /* maxsegsize*/ IPS_DRIVE_INFO_LEN, /* flags */ 0, &command->data_dmatag) != 0) { printf("ips: can't alloc dma tag for drive status\n"); error = ENOMEM; goto exit; } if(bus_dmamem_alloc(command->data_dmatag, &command->data_buffer, BUS_DMA_NOWAIT, &command->data_dmamap)){ error = ENOMEM; goto exit; } command->callback = ips_wakeup_callback; asleep(status, 0, "ips", 10*hz); bus_dmamap_load(command->data_dmatag, command->data_dmamap, command->data_buffer,IPS_DRIVE_INFO_LEN, ips_drive_info_callback, command, BUS_DMA_NOWAIT); if (await(-1, -1)) error = ETIMEDOUT; else { bus_dmamap_sync(command->data_dmatag, command->data_dmamap, BUS_DMASYNC_POSTREAD); driveinfo = command->data_buffer; memcpy(sc->drives, driveinfo->drives, sizeof(ips_drive_t) * 8); sc->drivecount = driveinfo->drivecount; device_printf(sc->dev, "logical drives: %d\n",sc->drivecount); } bus_dmamap_unload(command->data_dmatag, command->data_dmamap); exit: /* I suppose I should clean up my memory allocations */ bus_dmamem_free(command->data_dmatag, command->data_buffer, command->data_dmamap); bus_dma_tag_destroy(command->data_dmatag); ips_insert_free_cmd(sc, command); return error; }
static int ipsd_dump(struct dev_dump_args *ap) { cdev_t dev = ap->a_head.a_dev; ips_softc_t *sc; ips_command_t *command; ips_io_cmd *command_struct; ipsdisk_softc_t *dsc; off_t off; uint8_t *va; size_t len; int error = 0; dsc = dev->si_drv1; if (dsc == NULL) return (EINVAL); sc = dsc->sc; if (ips_get_free_cmd(sc, &command, 0) != 0) { kprintf("ipsd: failed to get cmd for dump\n"); return (ENOMEM); } command->data_dmatag = sc->sg_dmatag; command->callback = ipsd_dump_block_complete; command_struct = (ips_io_cmd *)command->command_buffer; command_struct->id = command->id; command_struct->drivenum = sc->drives[dsc->disk_number].drivenum; off = ap->a_offset; va = ap->a_virtual; size_t length = ap->a_length; while (length > 0) { len = length > IPS_MAX_IO_SIZE ? IPS_MAX_IO_SIZE : length; command_struct->lba = off / IPS_BLKSIZE; if (bus_dmamap_load(command->data_dmatag, command->data_dmamap, va, len, ipsd_dump_map_sg, command, 0) != 0) { error = EIO; break; } if (COMMAND_ERROR(&command->status)) { error = EIO; break; } length -= len; off += len; va += len; } ips_insert_free_cmd(command->sc, command); return(error); }
static void ips_ioctl_finish(ips_command_t *command) { ips_ioctl_t *ioctl_cmd = command->arg; if(ioctl_cmd->readwrite & IPS_IOCTL_READ){ bus_dmamap_sync(ioctl_cmd->dmatag, ioctl_cmd->dmamap, BUS_DMASYNC_POSTREAD); } else if(ioctl_cmd->readwrite & IPS_IOCTL_WRITE){ bus_dmamap_sync(ioctl_cmd->dmatag, ioctl_cmd->dmamap, BUS_DMASYNC_POSTWRITE); } bus_dmamap_sync(command->sc->command_dmatag, command->command_dmamap, BUS_DMASYNC_POSTWRITE); bus_dmamap_unload(ioctl_cmd->dmatag, ioctl_cmd->dmamap); ioctl_cmd->status.value = command->status.value; ips_insert_free_cmd(command->sc, command); }
static int ips_read_nvram(ips_command_t *command){ int error = 0; ips_softc_t *sc = command->sc; ips_cmd_status_t *status = command->arg; if (bus_dma_tag_create( /* parent */ sc->adapter_dmatag, /* alignemnt */ 1, /* boundary */ 0, /* lowaddr */ BUS_SPACE_MAXADDR_32BIT, /* highaddr */ BUS_SPACE_MAXADDR, /* filter */ NULL, /* filterarg */ NULL, /* maxsize */ IPS_NVRAM_PAGE_SIZE, /* numsegs */ 1, /* maxsegsize*/ IPS_NVRAM_PAGE_SIZE, /* flags */ 0, &command->data_dmatag) != 0) { printf("ips: can't alloc dma tag for nvram\n"); error = ENOMEM; goto exit; } if(bus_dmamem_alloc(command->data_dmatag, &command->data_buffer, BUS_DMA_NOWAIT, &command->data_dmamap)){ error = ENOMEM; goto exit; } command->callback = ips_write_nvram; asleep(status, 0, "ips", 0); bus_dmamap_load(command->data_dmatag, command->data_dmamap, command->data_buffer,IPS_NVRAM_PAGE_SIZE, ips_read_nvram_callback, command, BUS_DMA_NOWAIT); if (await(-1, -1)) error = ETIMEDOUT; else { bus_dmamap_sync(command->data_dmatag, command->data_dmamap, BUS_DMASYNC_POSTWRITE); } bus_dmamap_unload(command->data_dmatag, command->data_dmamap); exit: bus_dmamem_free(command->data_dmatag, command->data_buffer, command->data_dmamap); bus_dma_tag_destroy(command->data_dmatag); ips_insert_free_cmd(sc, command); return error; }
static int ips_send_drive_info_cmd(ips_command_t *command) { int error = 0; ips_softc_t *sc = command->sc; if (bus_dma_tag_create( /* parent */ sc->adapter_dmatag, /* alignemnt */ 1, /* boundary */ 0, /* lowaddr */ BUS_SPACE_MAXADDR_32BIT, /* highaddr */ BUS_SPACE_MAXADDR, /* filter */ NULL, /* filterarg */ NULL, /* maxsize */ IPS_DRIVE_INFO_LEN, /* numsegs */ 1, /* maxsegsize*/ IPS_DRIVE_INFO_LEN, /* flags */ 0, /* lockfunc */ NULL, /* lockarg */ NULL, &command->data_dmatag) != 0) { printf("ips: can't alloc dma tag for drive status\n"); error = ENOMEM; goto exit; } if(bus_dmamem_alloc(command->data_dmatag, &command->data_buffer, BUS_DMA_NOWAIT, &command->data_dmamap)){ error = ENOMEM; goto exit; } command->callback = ips_wakeup_callback; error = bus_dmamap_load(command->data_dmatag, command->data_dmamap, command->data_buffer,IPS_DRIVE_INFO_LEN, ips_drive_info_callback, command, BUS_DMA_NOWAIT); if (error == 0) bus_dmamap_unload(command->data_dmatag, command->data_dmamap); exit: /* I suppose I should clean up my memory allocations */ bus_dmamem_free(command->data_dmatag, command->data_buffer, command->data_dmamap); bus_dma_tag_destroy(command->data_dmatag); ips_insert_free_cmd(sc, command); return error; }
/* Below is a pair of functions for making sure data is safely * on disk by flushing the adapter's cache. */ static int ips_send_flush_cache_cmd(ips_command_t *command) { ips_softc_t *sc = command->sc; ips_generic_cmd *command_struct; PRINTF(10,"ips test: got a command, building flush command\n"); command->callback = ips_wakeup_callback; command_struct = (ips_generic_cmd *)command->command_buffer; command_struct->command = IPS_CACHE_FLUSH_CMD; command_struct->id = command->id; bus_dmamap_sync(sc->command_dmatag, command->command_dmamap, BUS_DMASYNC_PREWRITE); sc->ips_issue_cmd(command); if (COMMAND_ERROR(command) == 0) sema_wait(&sc->cmd_sema); ips_insert_free_cmd(sc, command); return 0; }
/* Below is a pair of functions for making sure data is safely * on disk by flushing the adapter's cache. */ static int ips_send_flush_cache_cmd(ips_command_t *command) { ips_softc_t *sc = command->sc; ips_cmd_status_t *status = command->arg; ips_generic_cmd *command_struct; PRINTF(10,"ips test: got a command, building flush command\n"); command->callback = ips_wakeup_callback; command_struct = (ips_generic_cmd *)command->command_buffer; command_struct->command = IPS_CACHE_FLUSH_CMD; command_struct->id = command->id; bus_dmamap_sync(sc->command_dmatag, command->command_dmamap, BUS_DMASYNC_PREWRITE); asleep(status, 0, "slush2", 0); sc->ips_issue_cmd(command); await(-1, -1); ips_insert_free_cmd(sc, command); return 0; }
/* Below are a series of functions for sending an IO request * to the adapter. The flow order is: start, send, callback, finish. * The caller must have already assembled an iorequest struct to hold * the details of the IO request. */ static void ips_io_request_finish(ips_command_t *command) { struct buf *iobuf = command->arg; if(ips_read_request(iobuf)) { bus_dmamap_sync(command->data_dmatag, command->data_dmamap, BUS_DMASYNC_POSTREAD); } else { bus_dmamap_sync(command->data_dmatag, command->data_dmamap, BUS_DMASYNC_POSTWRITE); } bus_dmamap_unload(command->data_dmatag, command->data_dmamap); bus_dmamap_destroy(command->data_dmatag, command->data_dmamap); if(COMMAND_ERROR(&command->status)){ iobuf->b_flags |=B_ERROR; iobuf->b_error = EIO; } ips_insert_free_cmd(command->sc, command); ipsd_finish(iobuf); }
static int ips_send_error_table_cmd(ips_command_t *command) { ips_softc_t *sc = command->sc; ips_cmd_status_t *status = command->arg; ips_generic_cmd *command_struct; PRINTF(10,"ips test: got a command, building errortable command\n"); command->callback = ips_wakeup_callback; command_struct = (ips_generic_cmd *)command->command_buffer; command_struct->command = IPS_ERROR_TABLE_CMD; command_struct->id = command->id; command_struct->reserve2 = IPS_CSL; bus_dmamap_sync(sc->command_dmatag, command->command_dmamap, BUS_DMASYNC_PREWRITE); asleep(status, 0, "ipsetc", 0); sc->ips_issue_cmd(command); await(-1, -1); ips_insert_free_cmd(sc, command); return 0; }
/* Below are a series of functions for sending an IO request * to the adapter. The flow order is: start, send, callback, finish. * The caller must have already assembled an iorequest struct to hold * the details of the IO request. */ static void ips_io_request_finish(ips_command_t *command) { struct bio *iobuf = command->arg; if(ips_read_request(iobuf)) { bus_dmamap_sync(command->data_dmatag, command->data_dmamap, BUS_DMASYNC_POSTREAD); } else { bus_dmamap_sync(command->data_dmatag, command->data_dmamap, BUS_DMASYNC_POSTWRITE); } bus_dmamap_unload(command->data_dmatag, command->data_dmamap); if(COMMAND_ERROR(command)){ iobuf->bio_flags |=BIO_ERROR; iobuf->bio_error = EIO; printf("ips: io error, status= 0x%x\n", command->status.value); } ips_insert_free_cmd(command->sc, command); ipsd_finish(iobuf); }
static int ips_send_io_request(ips_command_t *command) { ips_softc_t *sc = command->sc; struct buf *iobuf = command->arg; command->data_dmatag = sc->sg_dmatag; if(bus_dmamap_create(command->data_dmatag, 0, &command->data_dmamap)){ device_printf(sc->dev, "dmamap failed\n"); iobuf->b_flags |= B_ERROR; iobuf->b_error = ENOMEM; ips_insert_free_cmd(sc, command); ipsd_finish(iobuf); return 0; } command->callback = ips_io_request_finish; PRINTF(10, "ips test: : bcount %ld\n", iobuf->b_bcount); bus_dmamap_load(command->data_dmatag, command->data_dmamap, iobuf->b_data, iobuf->b_bcount, ips_io_request_callback, command, 0); return 0; }
static int ips_send_ffdc_reset_cmd(ips_command_t *command) { ips_softc_t *sc = command->sc; ips_adapter_ffdc_cmd *command_struct; PRINTF(10,"ips test: got a command, building ffdc reset command\n"); command->callback = ips_wakeup_callback; command_struct = (ips_adapter_ffdc_cmd *)command->command_buffer; command_struct->command = IPS_FFDC_CMD; command_struct->id = command->id; command_struct->reset_count = sc->ffdc_resetcount; command_struct->reset_type = 0x0; ips_ffdc_settime(command_struct, sc->ffdc_resettime.tv_sec); bus_dmamap_sync(sc->command_dmatag, command->command_dmamap, BUS_DMASYNC_PREWRITE); sc->ips_issue_cmd(command); if (COMMAND_ERROR(command) == 0) sema_wait(&sc->cmd_sema); ips_insert_free_cmd(sc, command); return 0; }
static void ips_ioctl_callback(void *cmdptr, bus_dma_segment_t *segments,int segnum, int error) { ips_command_t *command = cmdptr; ips_ioctl_t *ioctl_cmd = command->arg; ips_generic_cmd *command_buffer = command->command_buffer; if(error){ ioctl_cmd->status.value = IPS_ERROR_STATUS; ips_insert_free_cmd(command->sc, command); return; } command_buffer->id = command->id; command_buffer->buffaddr = segments[0].ds_addr; if(ioctl_cmd->readwrite & IPS_IOCTL_WRITE){ bus_dmamap_sync(ioctl_cmd->dmatag, ioctl_cmd->dmamap, BUS_DMASYNC_PREWRITE); } else if(ioctl_cmd->readwrite & IPS_IOCTL_READ){ bus_dmamap_sync(ioctl_cmd->dmatag, ioctl_cmd->dmamap, BUS_DMASYNC_PREREAD); } bus_dmamap_sync(command->sc->command_dmatag, command->command_dmamap, BUS_DMASYNC_PREWRITE); command->sc->ips_issue_cmd(command); }
/* Below are a series of functions for sending an adapter info request * to the adapter. The flow order is: get, send, callback. It uses * the generic finish callback at the top of this file. * This can be used to get configuration/status info from the card */ static void ips_adapter_info_callback(void *cmdptr, bus_dma_segment_t *segments,int segnum, int error) { ips_softc_t *sc; ips_command_t *command = cmdptr; ips_adapter_info_cmd *command_struct; sc = command->sc; if(error){ ips_cmd_status_t * status = command->arg; status->value = IPS_ERROR_STATUS; /* a lovely error value */ ips_insert_free_cmd(sc, command); printf("ips: error = %d in ips_get_adapter_info\n", error); return; } command_struct = (ips_adapter_info_cmd *)command->command_buffer; command_struct->command = IPS_ADAPTER_INFO_CMD; command_struct->id = command->id; command_struct->buffaddr = segments[0].ds_addr; bus_dmamap_sync(sc->command_dmatag, command->command_dmamap, BUS_DMASYNC_PREWRITE); bus_dmamap_sync(command->data_dmatag, command->data_dmamap, BUS_DMASYNC_PREREAD); sc->ips_issue_cmd(command); }
static void ips_io_request_callback(void *cmdptr, bus_dma_segment_t *segments,int segnum, int error) { ips_softc_t *sc; ips_command_t *command = cmdptr; ips_sg_element_t *sg_list; ips_io_cmd *command_struct; struct buf *iobuf = command->arg; int i, length = 0; u_int8_t cmdtype; sc = command->sc; if(error){ printf("ips: error = %d in ips_sg_request_callback\n", error); bus_dmamap_unload(command->data_dmatag, command->data_dmamap); bus_dmamap_destroy(command->data_dmatag, command->data_dmamap); iobuf->b_flags |= B_ERROR; iobuf->b_error = ENOMEM; ips_insert_free_cmd(sc, command); ipsd_finish(iobuf); return; } command_struct = (ips_io_cmd *)command->command_buffer; command_struct->id = command->id; command_struct->drivenum = (uintptr_t)iobuf->b_driver1; if(segnum != 1){ if(ips_read_request(iobuf)) cmdtype = IPS_SG_READ_CMD; else cmdtype = IPS_SG_WRITE_CMD; command_struct->segnum = segnum; sg_list = (ips_sg_element_t *)((u_int8_t *) command->command_buffer + IPS_COMMAND_LEN); for(i = 0; i < segnum; i++){ sg_list[i].addr = segments[i].ds_addr; sg_list[i].len = segments[i].ds_len; length += segments[i].ds_len; } command_struct->buffaddr = (u_int32_t)command->command_phys_addr + IPS_COMMAND_LEN; } else { if(ips_read_request(iobuf)) cmdtype = IPS_READ_CMD; else cmdtype = IPS_WRITE_CMD; command_struct->buffaddr = segments[0].ds_addr; length = segments[0].ds_len; } command_struct->command = cmdtype; command_struct->lba = iobuf->b_pblkno; length = (length + IPS_BLKSIZE - 1)/IPS_BLKSIZE; command_struct->length = length; bus_dmamap_sync(sc->command_dmatag, command->command_dmamap, BUS_DMASYNC_PREWRITE); if(ips_read_request(iobuf)) { bus_dmamap_sync(command->data_dmatag, command->data_dmamap, BUS_DMASYNC_PREREAD); } else { bus_dmamap_sync(command->data_dmatag, command->data_dmamap, BUS_DMASYNC_PREWRITE); } PRINTF(10, "ips test: command id: %d segments: %d " "pblkno: %lld length: %d, ds_len: %d\n", command->id, segnum, iobuf->b_pblkno, length, segments[0].ds_len); sc->ips_issue_cmd(command); return; }