From e44e3482bdb4d0ebde2d8b41830ac2cdb07948fb Mon Sep 17 00:00:00 2001 From: Yang Zhang Date: Fri, 28 Aug 2015 09:58:54 +0800 Subject: Add qemu 2.4.0 Change-Id: Ic99cbad4b61f8b127b7dc74d04576c0bcbaaf4f5 Signed-off-by: Yang Zhang --- qemu/roms/ipxe/src/net/fcns.c | 241 ++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 241 insertions(+) create mode 100644 qemu/roms/ipxe/src/net/fcns.c (limited to 'qemu/roms/ipxe/src/net/fcns.c') diff --git a/qemu/roms/ipxe/src/net/fcns.c b/qemu/roms/ipxe/src/net/fcns.c new file mode 100644 index 000000000..3ca4ad557 --- /dev/null +++ b/qemu/roms/ipxe/src/net/fcns.c @@ -0,0 +1,241 @@ +/* + * Copyright (C) 2010 Michael Brown . + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License as + * published by the Free Software Foundation; either version 2 of the + * License, or any later version. + * + * This program is distributed in the hope that it will be useful, but + * WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU + * General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA + * 02110-1301, USA. + */ + +FILE_LICENCE ( GPL2_OR_LATER ); + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +/** @file + * + * Fibre Channel name server lookups + * + */ + +/** A Fibre Channel name server query */ +struct fc_ns_query { + /** Reference count */ + struct refcnt refcnt; + /** Fibre Channel exchange */ + struct interface xchg; + + /** Fibre Channel peer */ + struct fc_peer *peer; + /** Fibre Channel port */ + struct fc_port *port; + + /** Process */ + struct process process; + /** Success handler + * + * @v peer Fibre Channel peer + * @v port Fibre Channel port + * @v peer_port_id Peer port ID + * @ret rc Return status code + */ + int ( * done ) ( struct fc_peer *peer, struct fc_port *port, + struct fc_port_id *peer_port_id ); +}; + +/** + * Free name server query + * + * @v refcnt Reference count + */ +static void fc_ns_query_free ( struct refcnt *refcnt ) { + struct fc_ns_query *query = + container_of ( refcnt, struct fc_ns_query, refcnt ); + + fc_peer_put ( query->peer ); + fc_port_put ( query->port ); + free ( query ); +} + +/** + * Close name server query + * + * @v query Name server query + * @v rc Reason for close + */ +static void fc_ns_query_close ( struct fc_ns_query *query, int rc ) { + + /* Stop process */ + process_del ( &query->process ); + + /* Shut down interfaces */ + intf_shutdown ( &query->xchg, rc ); +} + +/** + * Receive name server query response + * + * @v query Name server query + * @v iobuf I/O buffer + * @v meta Data transfer metadata + * @ret rc Return status code + */ +static int fc_ns_query_deliver ( struct fc_ns_query *query, + struct io_buffer *iobuf, + struct xfer_metadata *meta __unused ) { + union fc_ns_response *resp = iobuf->data; + struct fc_port_id *peer_port_id; + int rc; + + /* Sanity check */ + if ( iob_len ( iobuf ) < sizeof ( resp->ct ) ) { + DBGC ( query, "FCNS %p received underlength response (%zd " + "bytes)\n", query, iob_len ( iobuf ) ); + rc = -EINVAL; + goto done; + } + + /* Handle response */ + switch ( ntohs ( resp->ct.code ) ) { + case FC_GS_ACCEPT: + if ( iob_len ( iobuf ) < sizeof ( resp->gid_pn ) ) { + DBGC ( query, "FCNS %p received underlength accept " + "response (%zd bytes)\n", + query, iob_len ( iobuf ) ); + rc = -EINVAL; + goto done; + } + peer_port_id = &resp->gid_pn.port_id.port_id; + DBGC ( query, "FCNS %p resolved %s to %s via %s\n", + query, fc_ntoa ( &query->peer->port_wwn ), + fc_id_ntoa ( peer_port_id ), query->port->name ); + if ( ( rc = query->done ( query->peer, query->port, + peer_port_id ) ) != 0 ) + goto done; + break; + case FC_GS_REJECT: + DBGC ( query, "FCNS %p rejected (reason %02x explanation " + "%02x)\n", query, resp->reject.ct.reason, + resp->reject.ct.explanation ); + break; + default: + DBGC ( query, "FCNS %p received invalid response code %04x\n", + query, ntohs ( resp->ct.code ) ); + rc = -ENOTSUP; + goto done; + } + + rc = 0; + done: + free_iob ( iobuf ); + fc_ns_query_close ( query, rc ); + return rc; +} + +/** + * Name server query process + * + * @v query Name server query + */ +static void fc_ns_query_step ( struct fc_ns_query *query ) { + struct xfer_metadata meta; + struct fc_ns_gid_pn_request gid_pn; + int xchg_id; + int rc; + + /* Create exchange */ + if ( ( xchg_id = fc_xchg_originate ( &query->xchg, query->port, + &fc_gs_port_id, + FC_TYPE_CT ) ) < 0 ) { + rc = xchg_id; + DBGC ( query, "FCNS %p could not create exchange: %s\n", + query, strerror ( rc ) ); + fc_ns_query_close ( query, rc ); + return; + } + + /* Construct query request */ + memset ( &gid_pn, 0, sizeof ( gid_pn ) ); + gid_pn.ct.revision = FC_CT_REVISION; + gid_pn.ct.type = FC_GS_TYPE_DS; + gid_pn.ct.subtype = FC_DS_SUBTYPE_NAME; + gid_pn.ct.code = htons ( FC_NS_GET ( FC_NS_PORT_NAME, FC_NS_PORT_ID )); + memcpy ( &gid_pn.port_wwn, &query->peer->port_wwn, + sizeof ( gid_pn.port_wwn ) ); + memset ( &meta, 0, sizeof ( meta ) ); + meta.flags = XFER_FL_OVER; + + /* Send query */ + if ( ( rc = xfer_deliver_raw_meta ( &query->xchg, &gid_pn, + sizeof ( gid_pn ), &meta ) ) != 0){ + DBGC ( query, "FCNS %p could not deliver query: %s\n", + query, strerror ( rc ) ); + fc_ns_query_close ( query, rc ); + return; + } +} + +/** Name server exchange interface operations */ +static struct interface_operation fc_ns_query_xchg_op[] = { + INTF_OP ( xfer_deliver, struct fc_ns_query *, fc_ns_query_deliver ), + INTF_OP ( intf_close, struct fc_ns_query *, fc_ns_query_close ), +}; + +/** Name server exchange interface descriptor */ +static struct interface_descriptor fc_ns_query_xchg_desc = + INTF_DESC ( struct fc_ns_query, xchg, fc_ns_query_xchg_op ); + +/** Name server process descriptor */ +static struct process_descriptor fc_ns_query_process_desc = + PROC_DESC_ONCE ( struct fc_ns_query, process, fc_ns_query_step ); + +/** + * Issue Fibre Channel name server query + * + * @v peer Fibre Channel peer + * @v port Fibre Channel port + * @ret rc Return status code + */ +int fc_ns_query ( struct fc_peer *peer, struct fc_port *port, + int ( * done ) ( struct fc_peer *peer, struct fc_port *port, + struct fc_port_id *peer_port_id ) ) { + struct fc_ns_query *query; + + /* Allocate and initialise structure */ + query = zalloc ( sizeof ( *query ) ); + if ( ! query ) + return -ENOMEM; + ref_init ( &query->refcnt, fc_ns_query_free ); + intf_init ( &query->xchg, &fc_ns_query_xchg_desc, &query->refcnt ); + process_init ( &query->process, &fc_ns_query_process_desc, + &query->refcnt ); + query->peer = fc_peer_get ( peer ); + query->port = fc_port_get ( port ); + query->done = done; + + DBGC ( query, "FCNS %p querying %s via %s\n", + query, fc_ntoa ( &query->peer->port_wwn ), port->name ); + + /* Mortalise self and return */ + ref_put ( &query->refcnt ); + return 0; +} -- cgit 1.2.3-korg