sbp2.c

来自「linux 内核源代码」· C语言 代码 · 共 2,113 行 · 第 1/5 页

C
2,113 行
字号
			scsi_block_requests(lu->shost);		}	read_unlock_irqrestore(&sbp2_hi_logical_units_lock, flags);}static int sbp2_start_device(struct sbp2_lu *lu){	struct sbp2_fwhost_info *hi = lu->hi;	int error;	lu->login_response = dma_alloc_coherent(hi->host->device.parent,				     sizeof(struct sbp2_login_response),				     &lu->login_response_dma, GFP_KERNEL);	if (!lu->login_response)		goto alloc_fail;	lu->query_logins_orb = dma_alloc_coherent(hi->host->device.parent,				     sizeof(struct sbp2_query_logins_orb),				     &lu->query_logins_orb_dma, GFP_KERNEL);	if (!lu->query_logins_orb)		goto alloc_fail;	lu->query_logins_response = dma_alloc_coherent(hi->host->device.parent,				     sizeof(struct sbp2_query_logins_response),				     &lu->query_logins_response_dma, GFP_KERNEL);	if (!lu->query_logins_response)		goto alloc_fail;	lu->reconnect_orb = dma_alloc_coherent(hi->host->device.parent,				     sizeof(struct sbp2_reconnect_orb),				     &lu->reconnect_orb_dma, GFP_KERNEL);	if (!lu->reconnect_orb)		goto alloc_fail;	lu->logout_orb = dma_alloc_coherent(hi->host->device.parent,				     sizeof(struct sbp2_logout_orb),				     &lu->logout_orb_dma, GFP_KERNEL);	if (!lu->logout_orb)		goto alloc_fail;	lu->login_orb = dma_alloc_coherent(hi->host->device.parent,				     sizeof(struct sbp2_login_orb),				     &lu->login_orb_dma, GFP_KERNEL);	if (!lu->login_orb)		goto alloc_fail;	if (sbp2util_create_command_orb_pool(lu))		goto alloc_fail;	/* Wait a second before trying to log in. Previously logged in	 * initiators need a chance to reconnect. */	if (msleep_interruptible(1000)) {		sbp2_remove_device(lu);		return -EINTR;	}	if (sbp2_login_device(lu)) {		sbp2_remove_device(lu);		return -EBUSY;	}	sbp2_set_busy_timeout(lu);	sbp2_agent_reset(lu, 1);	sbp2_max_speed_and_size(lu);	error = scsi_add_device(lu->shost, 0, lu->ud->id, 0);	if (error) {		SBP2_ERR("scsi_add_device failed");		sbp2_logout_device(lu);		sbp2_remove_device(lu);		return error;	}	return 0;alloc_fail:	SBP2_ERR("Could not allocate memory for lu");	sbp2_remove_device(lu);	return -ENOMEM;}static void sbp2_remove_device(struct sbp2_lu *lu){	struct sbp2_fwhost_info *hi;	unsigned long flags;	if (!lu)		return;	hi = lu->hi;	if (!hi)		goto no_hi;	if (lu->shost) {		scsi_remove_host(lu->shost);		scsi_host_put(lu->shost);	}	flush_scheduled_work();	sbp2util_remove_command_orb_pool(lu, hi->host);	write_lock_irqsave(&sbp2_hi_logical_units_lock, flags);	list_del(&lu->lu_list);	write_unlock_irqrestore(&sbp2_hi_logical_units_lock, flags);	if (lu->login_response)		dma_free_coherent(hi->host->device.parent,				    sizeof(struct sbp2_login_response),				    lu->login_response,				    lu->login_response_dma);	if (lu->login_orb)		dma_free_coherent(hi->host->device.parent,				    sizeof(struct sbp2_login_orb),				    lu->login_orb,				    lu->login_orb_dma);	if (lu->reconnect_orb)		dma_free_coherent(hi->host->device.parent,				    sizeof(struct sbp2_reconnect_orb),				    lu->reconnect_orb,				    lu->reconnect_orb_dma);	if (lu->logout_orb)		dma_free_coherent(hi->host->device.parent,				    sizeof(struct sbp2_logout_orb),				    lu->logout_orb,				    lu->logout_orb_dma);	if (lu->query_logins_orb)		dma_free_coherent(hi->host->device.parent,				    sizeof(struct sbp2_query_logins_orb),				    lu->query_logins_orb,				    lu->query_logins_orb_dma);	if (lu->query_logins_response)		dma_free_coherent(hi->host->device.parent,				    sizeof(struct sbp2_query_logins_response),				    lu->query_logins_response,				    lu->query_logins_response_dma);	if (lu->status_fifo_addr != CSR1212_INVALID_ADDR_SPACE)		hpsb_unregister_addrspace(&sbp2_highlevel, hi->host,					  lu->status_fifo_addr);	lu->ud->device.driver_data = NULL;	module_put(hi->host->driver->owner);no_hi:	kfree(lu);}#ifdef CONFIG_IEEE1394_SBP2_PHYS_DMA/* * Deal with write requests on adapters which do not support physical DMA or * have it switched off. */static int sbp2_handle_physdma_write(struct hpsb_host *host, int nodeid,				     int destid, quadlet_t *data, u64 addr,				     size_t length, u16 flags){	memcpy(bus_to_virt((u32) addr), data, length);	return RCODE_COMPLETE;}/* * Deal with read requests on adapters which do not support physical DMA or * have it switched off. */static int sbp2_handle_physdma_read(struct hpsb_host *host, int nodeid,				    quadlet_t *data, u64 addr, size_t length,				    u16 flags){	memcpy(data, bus_to_virt((u32) addr), length);	return RCODE_COMPLETE;}#endif/************************************** * SBP-2 protocol related section **************************************/static int sbp2_query_logins(struct sbp2_lu *lu){	struct sbp2_fwhost_info *hi = lu->hi;	quadlet_t data[2];	int max_logins;	int active_logins;	lu->query_logins_orb->reserved1 = 0x0;	lu->query_logins_orb->reserved2 = 0x0;	lu->query_logins_orb->query_response_lo = lu->query_logins_response_dma;	lu->query_logins_orb->query_response_hi =			ORB_SET_NODE_ID(hi->host->node_id);	lu->query_logins_orb->lun_misc =			ORB_SET_FUNCTION(SBP2_QUERY_LOGINS_REQUEST);	lu->query_logins_orb->lun_misc |= ORB_SET_NOTIFY(1);	lu->query_logins_orb->lun_misc |= ORB_SET_LUN(lu->lun);	lu->query_logins_orb->reserved_resp_length =		ORB_SET_QUERY_LOGINS_RESP_LENGTH(			sizeof(struct sbp2_query_logins_response));	lu->query_logins_orb->status_fifo_hi =		ORB_SET_STATUS_FIFO_HI(lu->status_fifo_addr, hi->host->node_id);	lu->query_logins_orb->status_fifo_lo =		ORB_SET_STATUS_FIFO_LO(lu->status_fifo_addr);	sbp2util_cpu_to_be32_buffer(lu->query_logins_orb,				    sizeof(struct sbp2_query_logins_orb));	memset(lu->query_logins_response, 0,	       sizeof(struct sbp2_query_logins_response));	data[0] = ORB_SET_NODE_ID(hi->host->node_id);	data[1] = lu->query_logins_orb_dma;	sbp2util_cpu_to_be32_buffer(data, 8);	hpsb_node_write(lu->ne, lu->management_agent_addr, data, 8);	if (sbp2util_access_timeout(lu, 2*HZ)) {		SBP2_INFO("Error querying logins to SBP-2 device - timed out");		return -EIO;	}	if (lu->status_block.ORB_offset_lo != lu->query_logins_orb_dma) {		SBP2_INFO("Error querying logins to SBP-2 device - timed out");		return -EIO;	}	if (STATUS_TEST_RDS(lu->status_block.ORB_offset_hi_misc)) {		SBP2_INFO("Error querying logins to SBP-2 device - failed");		return -EIO;	}	sbp2util_cpu_to_be32_buffer(lu->query_logins_response,				    sizeof(struct sbp2_query_logins_response));	max_logins = RESPONSE_GET_MAX_LOGINS(			lu->query_logins_response->length_max_logins);	SBP2_INFO("Maximum concurrent logins supported: %d", max_logins);	active_logins = RESPONSE_GET_ACTIVE_LOGINS(			lu->query_logins_response->length_max_logins);	SBP2_INFO("Number of active logins: %d", active_logins);	if (active_logins >= max_logins) {		return -EIO;	}	return 0;}static int sbp2_login_device(struct sbp2_lu *lu){	struct sbp2_fwhost_info *hi = lu->hi;	quadlet_t data[2];	if (!lu->login_orb)		return -EIO;	if (!sbp2_exclusive_login && sbp2_query_logins(lu)) {		SBP2_INFO("Device does not support any more concurrent logins");		return -EIO;	}	/* assume no password */	lu->login_orb->password_hi = 0;	lu->login_orb->password_lo = 0;	lu->login_orb->login_response_lo = lu->login_response_dma;	lu->login_orb->login_response_hi = ORB_SET_NODE_ID(hi->host->node_id);	lu->login_orb->lun_misc = ORB_SET_FUNCTION(SBP2_LOGIN_REQUEST);	/* one second reconnect time */	lu->login_orb->lun_misc |= ORB_SET_RECONNECT(0);	lu->login_orb->lun_misc |= ORB_SET_EXCLUSIVE(sbp2_exclusive_login);	lu->login_orb->lun_misc |= ORB_SET_NOTIFY(1);	lu->login_orb->lun_misc |= ORB_SET_LUN(lu->lun);	lu->login_orb->passwd_resp_lengths =		ORB_SET_LOGIN_RESP_LENGTH(sizeof(struct sbp2_login_response));	lu->login_orb->status_fifo_hi =		ORB_SET_STATUS_FIFO_HI(lu->status_fifo_addr, hi->host->node_id);	lu->login_orb->status_fifo_lo =		ORB_SET_STATUS_FIFO_LO(lu->status_fifo_addr);	sbp2util_cpu_to_be32_buffer(lu->login_orb,				    sizeof(struct sbp2_login_orb));	memset(lu->login_response, 0, sizeof(struct sbp2_login_response));	data[0] = ORB_SET_NODE_ID(hi->host->node_id);	data[1] = lu->login_orb_dma;	sbp2util_cpu_to_be32_buffer(data, 8);	hpsb_node_write(lu->ne, lu->management_agent_addr, data, 8);	/* wait up to 20 seconds for login status */	if (sbp2util_access_timeout(lu, 20*HZ)) {		SBP2_ERR("Error logging into SBP-2 device - timed out");		return -EIO;	}	/* make sure that the returned status matches the login ORB */	if (lu->status_block.ORB_offset_lo != lu->login_orb_dma) {		SBP2_ERR("Error logging into SBP-2 device - timed out");		return -EIO;	}	if (STATUS_TEST_RDS(lu->status_block.ORB_offset_hi_misc)) {		SBP2_ERR("Error logging into SBP-2 device - failed");		return -EIO;	}	sbp2util_cpu_to_be32_buffer(lu->login_response,				    sizeof(struct sbp2_login_response));	lu->command_block_agent_addr =			((u64)lu->login_response->command_block_agent_hi) << 32;	lu->command_block_agent_addr |=			((u64)lu->login_response->command_block_agent_lo);	lu->command_block_agent_addr &= 0x0000ffffffffffffULL;	SBP2_INFO("Logged into SBP-2 device");	return 0;}static int sbp2_logout_device(struct sbp2_lu *lu){	struct sbp2_fwhost_info *hi = lu->hi;	quadlet_t data[2];	int error;	lu->logout_orb->reserved1 = 0x0;	lu->logout_orb->reserved2 = 0x0;	lu->logout_orb->reserved3 = 0x0;	lu->logout_orb->reserved4 = 0x0;	lu->logout_orb->login_ID_misc = ORB_SET_FUNCTION(SBP2_LOGOUT_REQUEST);	lu->logout_orb->login_ID_misc |=			ORB_SET_LOGIN_ID(lu->login_response->length_login_ID);	lu->logout_orb->login_ID_misc |= ORB_SET_NOTIFY(1);	lu->logout_orb->reserved5 = 0x0;	lu->logout_orb->status_fifo_hi =		ORB_SET_STATUS_FIFO_HI(lu->status_fifo_addr, hi->host->node_id);	lu->logout_orb->status_fifo_lo =		ORB_SET_STATUS_FIFO_LO(lu->status_fifo_addr);	sbp2util_cpu_to_be32_buffer(lu->logout_orb,				    sizeof(struct sbp2_logout_orb));	data[0] = ORB_SET_NODE_ID(hi->host->node_id);	data[1] = lu->logout_orb_dma;	sbp2util_cpu_to_be32_buffer(data, 8);	error = hpsb_node_write(lu->ne, lu->management_agent_addr, data, 8);	if (error)		return error;	/* wait up to 1 second for the device to complete logout */	if (sbp2util_access_timeout(lu, HZ))		return -EIO;	SBP2_INFO("Logged out of SBP-2 device");	return 0;}static int sbp2_reconnect_device(struct sbp2_lu *lu){	struct sbp2_fwhost_info *hi = lu->hi;	quadlet_t data[2];	int error;	lu->reconnect_orb->reserved1 = 0x0;	lu->reconnect_orb->reserved2 = 0x0;	lu->reconnect_orb->reserved3 = 0x0;	lu->reconnect_orb->reserved4 = 0x0;	lu->reconnect_orb->login_ID_misc =			ORB_SET_FUNCTION(SBP2_RECONNECT_REQUEST);	lu->reconnect_orb->login_ID_misc |=			ORB_SET_LOGIN_ID(lu->login_response->length_login_ID);	lu->reconnect_orb->login_ID_misc |= ORB_SET_NOTIFY(1);	lu->reconnect_orb->reserved5 = 0x0;	lu->reconnect_orb->status_fifo_hi =		ORB_SET_STATUS_FIFO_HI(lu->status_fifo_addr, hi->host->node_id);	lu->reconnect_orb->status_fifo_lo =		ORB_SET_STATUS_FIFO_LO(lu->status_fifo_addr);	sbp2util_cpu_to_be32_buffer(lu->reconnect_orb,				    sizeof(struct sbp2_reconnect_orb));	data[0] = ORB_SET_NODE_ID(hi->host->node_id);	data[1] = lu->reconnect_orb_dma;	sbp2util_cpu_to_be32_buffer(data, 8);	error = hpsb_node_write(lu->ne, lu->management_agent_addr, data, 8);	if (error)		return error;	/* wait up to 1 second for reconnect status */	if (sbp2util_access_timeout(lu, HZ)) {		SBP2_ERR("Error reconnecting to SBP-2 device - timed out");		return -EIO;	}	/* make sure that the returned status matches the reconnect ORB */	if (lu->status_block.ORB_offset_lo != lu->reconnect_orb_dma) {		SBP2_ERR("Error reconnecting to SBP-2 device - timed out");		return -EIO;	}	if (STATUS_TEST_RDS(lu->status_block.ORB_offset_hi_misc)) {		SBP2_ERR("Error reconnecting to SBP-2 device - failed");		return -EIO;	}	SBP2_INFO("Reconnected to SBP-2 device");	return 0;}/* * Set the target node's Single Phase Retry limit. Affects the target's retry * behaviour if our node is too busy to accept requests. */static int sbp2_set_busy_timeout(struct sbp2_lu *lu)

⌨️ 快捷键说明

复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?