drivers/scsi/esp_scsi.c

190 			     "ent[%d] %s val[%02x] sreg[%02x] seqreg[%02x] "
404 static dma_addr_t esp_cur_dma_addr(struct esp_cmd_entry *ent,
409 	if (ent->flags & ESP_CMD_FLAG_AUTOSENSE) {
410 		return ent->sense_dma +
411 			(ent->sense_ptr - cmd->sense_buffer);
419 static unsigned int esp_cur_dma_len(struct esp_cmd_entry *ent,
424 	if (ent->flags & ESP_CMD_FLAG_AUTOSENSE) {
426 			(ent->sense_ptr - cmd->sense_buffer);
431 static void esp_advance_dma(struct esp *esp, struct esp_cmd_entry *ent,
436 	if (ent->flags & ESP_CMD_FLAG_AUTOSENSE) {
437 		ent->sense_ptr += len;
465 static void esp_save_pointers(struct esp *esp, struct esp_cmd_entry *ent)
467 	struct scsi_cmnd *cmd = ent->cmd;
470 	if (ent->flags & ESP_CMD_FLAG_AUTOSENSE) {
471 		ent->saved_sense_ptr = ent->sense_ptr;
474 	ent->saved_cur_residue = spriv->cur_residue;
475 	ent->saved_prv_sg = spriv->prv_sg;
476 	ent->saved_cur_sg = spriv->cur_sg;
477 	ent->saved_tot_residue = spriv->tot_residue;
480 static void esp_restore_pointers(struct esp *esp, struct esp_cmd_entry *ent)
482 	struct scsi_cmnd *cmd = ent->cmd;
485 	if (ent->flags & ESP_CMD_FLAG_AUTOSENSE) {
486 		ent->sense_ptr = ent->saved_sense_ptr;
489 	spriv->cur_residue = ent->saved_cur_residue;
490 	spriv->prv_sg = ent->saved_prv_sg;
491 	spriv->cur_sg = ent->saved_cur_sg;
492 	spriv->tot_residue = ent->saved_tot_residue;
574 static int esp_alloc_lun_tag(struct esp_cmd_entry *ent,
577 	if (!ent->orig_tag[0]) {
601 		lp->non_tagged_cmd = ent;
609 	BUG_ON(lp->tagged_cmds[ent->orig_tag[1]]);
611 	lp->tagged_cmds[ent->orig_tag[1]] = ent;
617 static void esp_free_lun_tag(struct esp_cmd_entry *ent,
620 	if (ent->orig_tag[0]) {
621 		BUG_ON(lp->tagged_cmds[ent->orig_tag[1]] != ent);
622 		lp->tagged_cmds[ent->orig_tag[1]] = NULL;
625 		BUG_ON(lp->non_tagged_cmd != ent);
630 static void esp_map_sense(struct esp *esp, struct esp_cmd_entry *ent)
632 	ent->sense_ptr = ent->cmd->sense_buffer;
634 		ent->sense_dma = (uintptr_t)ent->sense_ptr;
638 	ent->sense_dma = dma_map_single(esp->dev, ent->sense_ptr,
642 static void esp_unmap_sense(struct esp *esp, struct esp_cmd_entry *ent)
645 		dma_unmap_single(esp->dev, ent->sense_dma,
647 	ent->sense_ptr = NULL;
657 static void esp_autosense(struct esp *esp, struct esp_cmd_entry *ent)
659 	struct scsi_cmnd *cmd = ent->cmd;
668 	if (!ent->sense_ptr) {
671 		esp_map_sense(esp, ent);
673 	ent->saved_sense_ptr = ent->sense_ptr;
675 	esp->active_cmd = ent;
706 	struct esp_cmd_entry *ent;
708 	list_for_each_entry(ent, &esp->queued_cmds, list) {
709 		struct scsi_cmnd *cmd = ent->cmd;
713 		if (ent->flags & ESP_CMD_FLAG_AUTOSENSE) {
714 			ent->tag[0] = 0;
715 			ent->tag[1] = 0;
716 			return ent;
719 		if (!spi_populate_tag_msg(&ent->tag[0], cmd)) {
720 			ent->tag[0] = 0;
721 			ent->tag[1] = 0;
723 		ent->orig_tag[0] = ent->tag[0];
724 		ent->orig_tag[1] = ent->tag[1];
726 		if (esp_alloc_lun_tag(ent, lp) < 0)
729 		return ent;
740 	struct esp_cmd_entry *ent;
750 	ent = find_and_prep_issuable_command(esp);
751 	if (!ent)
754 	if (ent->flags & ESP_CMD_FLAG_AUTOSENSE) {
755 		esp_autosense(esp, ent);
759 	cmd = ent->cmd;
765 	list_move(&ent->list, &esp->active_cmds);
767 	esp->active_cmd = ent;
770 	esp_save_pointers(esp, ent);
822 	if (ent->tag[0] && esp->rev == ESP100) {
833 		if (ent->tag[0]) {
837 			esp->msg_out[0] = ent->tag[0];
838 			esp->msg_out[1] = ent->tag[1];
846 		if (ent->tag[0]) {
847 			*p++ = ent->tag[0];
848 			*p++ = ent->tag[1];
893 static void esp_put_ent(struct esp *esp, struct esp_cmd_entry *ent)
895 	list_add(&ent->list, &esp->esp_cmd_pool);
898 static void esp_cmd_is_done(struct esp *esp, struct esp_cmd_entry *ent,
907 	esp_free_lun_tag(ent, dev->hostdata);
911 		set_status_byte(cmd, ent->status);
913 	if (ent->eh_done) {
914 		complete(ent->eh_done);
915 		ent->eh_done = NULL;
918 	if (ent->flags & ESP_CMD_FLAG_AUTOSENSE) {
919 		esp_unmap_sense(esp, ent);
927 		ent->flags &= ~ESP_CMD_FLAG_AUTOSENSE;
941 	list_del(&ent->list);
942 	esp_put_ent(esp, ent);
947 static void esp_event_queue_full(struct esp *esp, struct esp_cmd_entry *ent)
949 	struct scsi_device *dev = ent->cmd->device;
960 	struct esp_cmd_entry *ent;
962 	ent = esp_get_ent(esp);
963 	if (!ent)
966 	ent->cmd = cmd;
971 	list_add_tail(&ent->list, &esp->queued_cmds);
1049 	struct esp_cmd_entry *ent;
1126 	ent = lp->tagged_cmds[esp->command_block[1]];
1127 	if (!ent) {
1134 	return ent;
1139 	struct esp_cmd_entry *ent;
1203 	ent = lp->non_tagged_cmd;
1204 	if (!ent) {
1205 		ent = esp_reconnect_with_tag(esp, lp);
1206 		if (!ent)
1210 	esp->active_cmd = ent;
1213 	esp_restore_pointers(esp, ent);
1224 	struct esp_cmd_entry *ent;
1231 	ent = esp->active_cmd;
1232 	cmd = ent->cmd;
1239 		esp_cmd_is_done(esp, ent, cmd, DID_ERROR);
1252 		if (!(ent->flags & ESP_CMD_FLAG_AUTOSENSE)) {
1254 			esp_free_lun_tag(ent, cmd->device->hostdata);
1259 			esp_unmap_sense(esp, ent);
1265 		list_move(&ent->list, &esp->queued_cmds);
1284 		esp_cmd_is_done(esp, ent, cmd, DID_BAD_TARGET);
1316 static int esp_data_bytes_sent(struct esp *esp, struct esp_cmd_entry *ent,
1347 	if (fifo_cnt == 1 && ent->flags & ESP_CMD_FLAG_RESIDUAL) {
1352 		if (ent->flags & ESP_CMD_FLAG_AUTOSENSE)
1353 			ent->sense_ptr[bytes_sent] = bval;
1366 		ent->flags &= ~ESP_CMD_FLAG_RESIDUAL;
1368 	if (!(ent->flags & ESP_CMD_FLAG_WRITE))
1400 		if (!(ent->flags & ESP_CMD_FLAG_WRITE))
1451 	struct esp_cmd_entry *ent = esp->active_cmd;
1452 	struct scsi_cmnd *cmd = ent->cmd;
1591 	struct esp_cmd_entry *ent = esp->active_cmd;
1592 	struct scsi_cmnd *cmd = ent->cmd;
1639 		struct esp_cmd_entry *ent;
1647 		ent = esp->active_cmd;
1648 		spriv = ESP_CMD_PRIV(ent->cmd);
1669 		struct esp_cmd_entry *ent = esp->active_cmd;
1671 		ent->message = msg0;
1739 		struct esp_cmd_entry *ent = esp->active_cmd;
1740 		struct scsi_cmnd *cmd = ent->cmd;
1741 		dma_addr_t dma_addr = esp_cur_dma_addr(ent, cmd);
1742 		unsigned int dma_len = esp_cur_dma_len(ent, cmd);
1748 			ent->flags |= ESP_CMD_FLAG_WRITE;
1750 			ent->flags &= ~ESP_CMD_FLAG_WRITE;
1765 				     (unsigned long long)esp_cur_dma_addr(ent, cmd),
1766 				     esp_cur_dma_len(ent, cmd));
1780 		struct esp_cmd_entry *ent = esp->active_cmd;
1781 		struct scsi_cmnd *cmd = ent->cmd;
1791 		if (ent->flags & ESP_CMD_FLAG_WRITE) {
1808 		bytes_sent = esp_data_bytes_sent(esp, ent, cmd);
1811 				 ent->flags, bytes_sent);
1819 		esp_advance_dma(esp, ent, cmd, bytes_sent);
1825 		struct esp_cmd_entry *ent = esp->active_cmd;
1828 			ent->status = esp_read8(ESP_FDATA);
1829 			ent->message = esp_read8(ESP_FDATA);
1832 			ent->status = esp_read8(ESP_FDATA);
1833 			ent->message = 0xff;
1838 		if (ent->message != COMMAND_COMPLETE) {
1841 				     ent->message);
1851 		struct esp_cmd_entry *ent = esp->active_cmd;
1852 		struct scsi_cmnd *cmd = ent->cmd;
1854 		if (ent->message == COMMAND_COMPLETE ||
1855 		    ent->message == DISCONNECT)
1858 		if (ent->message == COMMAND_COMPLETE) {
1860 					ent->status, ent->message);
1861 			if (ent->status == SAM_STAT_TASK_SET_FULL)
1862 				esp_event_queue_full(esp, ent);
1864 			if (ent->status == SAM_STAT_CHECK_CONDITION &&
1865 			    !(ent->flags & ESP_CMD_FLAG_AUTOSENSE)) {
1866 				ent->flags |= ESP_CMD_FLAG_AUTOSENSE;
1867 				esp_autosense(esp, ent);
1869 				esp_cmd_is_done(esp, ent, cmd, DID_OK);
1871 		} else if (ent->message == DISCONNECT) {
1874 					   ent->tag[0], ent->tag[1]);
1881 				     ent->message);
2028 static void esp_reset_cleanup_one(struct esp *esp, struct esp_cmd_entry *ent)
2030 	struct scsi_cmnd *cmd = ent->cmd;
2033 	esp_free_lun_tag(ent, cmd->device->hostdata);
2036 	if (ent->flags & ESP_CMD_FLAG_AUTOSENSE)
2037 		esp_unmap_sense(esp, ent);
2040 	list_del(&ent->list);
2041 	esp_put_ent(esp, ent);
2054 	struct esp_cmd_entry *ent, *tmp;
2057 	list_for_each_entry_safe(ent, tmp, &esp->queued_cmds, list) {
2058 		struct scsi_cmnd *cmd = ent->cmd;
2060 		list_del(&ent->list);
2063 		esp_put_ent(esp, ent);
2066 	list_for_each_entry_safe(ent, tmp, &esp->active_cmds, list) {
2067 		if (ent == esp->active_cmd)
2069 		esp_reset_cleanup_one(esp, ent);
2493 	struct esp_cmd_entry *ent, *tmp;
2503 	ent = esp->active_cmd;
2504 	if (ent)
2507 			     ent->cmd, ent->cmd->cmnd[0]);
2508 	list_for_each_entry(ent, &esp->queued_cmds, list) {
2510 			     ent->cmd, ent->cmd->cmnd[0]);
2512 	list_for_each_entry(ent, &esp->active_cmds, list) {
2514 			     ent->cmd, ent->cmd->cmnd[0]);
2521 	ent = NULL;
2524 			ent = tmp;
2529 	if (ent) {
2533 		list_del(&ent->list);
2538 		esp_put_ent(esp, ent);
2545 	ent = esp->active_cmd;
2546 	if (ent && ent->cmd == cmd) {
2559 		ent->eh_done = &eh_done;
2586 		ent->eh_done = NULL;