30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * CDDL HEADER START
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * The contents of this file are subject to the terms of the
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Common Development and Distribution License (the "License").
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * You may not use this file except in compliance with the License.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * or http://www.opensolaris.org/os/licensing.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * See the License for the specific language governing permissions
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * and limitations under the License.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * When distributing Covered Code, include this CDDL HEADER in each
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * If applicable, add the following below this CDDL HEADER, with the
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * fields enclosed by brackets "[]" replaced with your own identifying
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * information: Portions Copyright [yyyy] [name of copyright owner]
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * CDDL HEADER END
e9406929914976efdccb875f94e90e85cdb076e3Mike Christensen * Copyright (c) 2008, 2010, Oracle and/or its affiliates. All rights reserved.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Domain Services Module Common Code.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * This module is intended to be used by both Solaris and the VBSC
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * All DS ports in the system
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * The list of DS ports is read in from the MD when the DS module is
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * initialized and is never modified. This eliminates the need for
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * locking to access the port array itself. Access to the individual
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * ports are synchronized at the port level.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_portset_t ds_allports; /* all DS ports in the system */
3ef557bf6acbaf0905479800b87d010f8715a11eMike Christensends_portset_t ds_nullport; /* allows test against null portset */
40c61268017ed628fcfb89162250c59130d14824Mike Christensen/* DS SP port id */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Table of registered services
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Locking: Accesses to the table of services are synchronized using
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * a mutex lock. The reader lock must be held when looking up service
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * information in the table. The writer lock must be held when any
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * service information is being modified.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Flag to prevent callbacks while in the middle of DS teardown.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenboolean_t ds_enabled = B_FALSE; /* enable/disable taskq processing */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Retry count and delay for LDC reads and writes
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen#define DS_DEFAULT_RETRIES 10000 /* number of times to retry */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen#define DS_DEFAULT_DELAY 1000 /* usecs to wait between retries */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Supported versions of the DS message protocol
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * The version array must be sorted in order from the highest
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * supported version to the lowest. Support for a particular
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * <major>.<minor> version implies all lower minor versions of
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * that same major version are supported as well.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen#define DS_NUM_VER (sizeof (ds_vers) / sizeof (ds_vers[0]))
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen/* incoming message handling functions */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensentypedef void (*ds_msg_handler_t)(ds_port_t *port, caddr_t buf, size_t len);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_handle_init_req(ds_port_t *port, caddr_t buf, size_t len);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_handle_init_ack(ds_port_t *port, caddr_t buf, size_t len);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_handle_init_nack(ds_port_t *port, caddr_t buf, size_t len);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_handle_reg_req(ds_port_t *port, caddr_t buf, size_t len);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_handle_reg_ack(ds_port_t *port, caddr_t buf, size_t len);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_handle_reg_nack(ds_port_t *port, caddr_t buf, size_t len);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_handle_unreg_req(ds_port_t *port, caddr_t buf, size_t len);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_handle_unreg_ack(ds_port_t *port, caddr_t buf, size_t len);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_handle_unreg_nack(ds_port_t *port, caddr_t buf, size_t len);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_handle_data(ds_port_t *port, caddr_t buf, size_t len);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_handle_nack(ds_port_t *port, caddr_t buf, size_t len);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * DS Message Handler Dispatch Table
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * A table used to dispatch all incoming messages. This table
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * contains handlers for all the fixed message types, as well as
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * the the messages defined in the 1.0 version of the DS protocol.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * The handlers are indexed based on the DS header msg_type values
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic const ds_msg_handler_t ds_msg_handlers[] = {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen/* initialization functions */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen/* event processing functions */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic uint_t ds_ldc_cb(uint64_t event, caddr_t arg);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic int ds_recv_msg(ds_port_t *port, caddr_t msgp, size_t *sizep);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_handle_up_event(ds_port_t *port);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_handle_down_reset_events(ds_port_t *port);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen/* message sending functions */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic int ds_send_msg(ds_port_t *port, caddr_t msg, size_t msglen);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic int ds_send_reg_req(ds_svc_t *svc, ds_port_t *port);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_send_unreg_nack(ds_port_t *port, ds_svc_hdl_t bad_hdl);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_send_data_nack(ds_port_t *port, ds_svc_hdl_t bad_hdl);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen/* walker functions */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic int ds_svc_isfree(ds_svc_t *svc, void *arg);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic int ds_svc_unregister(ds_svc_t *svc, void *arg);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic int ds_svc_port_up(ds_svc_t *svc, void *arg);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen/* service utilities */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_reset_svc(ds_svc_t *svc, ds_port_t *port);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic int ds_svc_register_onport(ds_svc_t *svc, ds_port_t *port);
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensenstatic int ds_svc_register_onport_walker(ds_svc_t *svc, void *arg);
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensenstatic void ds_set_port_ready(ds_port_t *port, uint16_t major, uint16_t minor);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen/* port utilities */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic ldc_status_t ds_update_ldc_state(ds_port_t *port);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen/* misc utilities */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void min_max_versions(int num_versions, ds_ver_t *sup_versionsp,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic char *decode_ldc_events(uint64_t event, char *buf);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen/* loopback */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_loopback_register(ds_svc_hdl_t hdl);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_loopback_unregister(ds_svc_hdl_t hdl);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_loopback_send(ds_svc_hdl_t hdl, void *buf, size_t buflen);
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensenstatic int ds_loopback_set_svc(ds_svc_t *svc, ds_capability_t *cap,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen/* client handling */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic int i_ds_hdl_lookup(char *service, uint_t is_client, ds_svc_hdl_t *hdlp,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic ds_svc_t *ds_find_clnt_svc_by_hdl_port(ds_svc_hdl_t hdl,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic ds_svc_t *ds_find_svc_by_id_port(char *svc_id, int is_client,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic ds_svc_t *ds_svc_clone(ds_svc_t *svc);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_check_for_dup_services(ds_svc_t *svc);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic void ds_delete_svc_entry(ds_svc_t *svc);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* Validate version table */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen ASSERT(ds_vers_isvalid(ds_vers, DS_NUM_VER) == DS_VERS_OK);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* Initialize services table */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* enable callback processing */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen/* BEGIN LDC SUPPORT FUNCTIONS */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensendecode_ldc_events(uint64_t event, char *buf)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (event & LDC_EVT_DOWN) (void) strcat(buf, " DOWN");
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (event & LDC_EVT_RESET) (void) strcat(buf, " RESET");
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (event & LDC_EVT_UP) (void) strcat(buf, " UP");
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (event & LDC_EVT_READ) (void) strcat(buf, " READ");
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (event & LDC_EVT_WRITE) (void) strcat(buf, " WRITE");
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Read status and update ldc state info in port structure.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((rv = ldc_status(port->ldc.hdl, &ldc_state)) != 0) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: %s: ldc_status error: %s" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), __func__, ds_errno_to_str(rv, ebuf));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_handle_down_reset_events(ds_port_t *port)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: %s: entered" DS_EOL, PORTID(port),
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* reset the port state */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* acknowledge the reset */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: %s: exit" DS_EOL, PORTID(port), __func__);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: %s: entered" DS_EOL, PORTID(port),
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((ldc_state == LDC_UP) && IS_DS_PORT(port)) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Initiate the handshake.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: %s: exit" DS_EOL, PORTID(port), __func__);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: %s: %s event (%llx) received" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), __func__, decode_ldc_events(event, evstring),
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: %s: callback handling is disabled"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (event & (LDC_EVT_DOWN | LDC_EVT_RESET)) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: %s: LDC READ event while "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "port not up" DS_EOL, PORTID(port), __func__);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (ds_sys_dispatch_func(ds_handle_recv, port)) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: error initiating LDC READ "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: %s: LDC WRITE event received, "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "not supported" DS_EOL, PORTID(port), __func__);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (event & ~(LDC_EVT_UP | LDC_EVT_READ)) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: %s: Unexpected LDC event received: "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: %s: exit" DS_EOL, PORTID(port), __func__);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: %s: ldc_id=%lld" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), __func__, (u_longlong_t)port->ldc.id);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((rv = ldc_init(port->ldc.id, &ldc_attr, &port->ldc.hdl)) != 0) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: %s: ldc_id: %lx, ldc_init error: %s"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), __func__, port->ldc.id,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen rv = ldc_reg_callback(port->ldc.hdl, ds_ldc_cb, ldc_cb_arg);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: %s: ldc_reg_callback error: %s"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), __func__, ds_errno_to_str(rv, ebuf));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: %s: ldc_id=%ld" DS_EOL, PORTID(port),
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((rv = ldc_close(port->ldc.hdl)) != 0) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: %s: ldc_close error: %s" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), __func__, ds_errno_to_str(rv, ebuf));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((rv = ldc_unreg_callback(port->ldc.hdl)) != 0) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: %s: ldc_unreg_callback error: %s"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), __func__, ds_errno_to_str(rv, ebuf));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: %s: ldc_fini error: %s" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), __func__, ds_errno_to_str(rv, ebuf));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Attempt to read a specified number of bytes from a particular LDC.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Returns zero for success or the return code from the LDC read on
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * failure. The actual number of bytes read from the LDC is returned
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * in the size parameter.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_recv_msg(ds_port_t *port, caddr_t msgp, size_t *sizep)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: attempting to read %ld bytes" DS_EOL,
beba1dd881728e806abb8621851ae851da168a08Mike Christensen rv = ldc_read(port->ldc.hdl, msgp, &nbytes);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* reset counter on a successful read */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * No data was read. Check if this is the
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * first attempt. If so, just return since
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * nothing has been read yet.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: read zero bytes, "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen " no data available" DS_EOL, PORTID(port));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * A retry is necessary because the read returned
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * EAGAIN, or a zero length read occurred after
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * reading a partial message.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: timed out waiting for "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: %s..." DS_EOL, PORTID(port), __func__);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Read messages from the channel until there are none
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * pending. Valid messages are dispatched to be handled
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * by a separate thread while any malformed messages are
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "ds@%lx: %s: reading next message" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Read in the next message.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* read in the message header */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((rv = ds_recv_msg(port, currp, &read_size)) != 0) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * A zero length read is a valid signal that
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * there is no data left on the channel.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: invalid message "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "length, received %ld bytes, expected %ld"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), read_size, DS_HDR_SZ);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* get payload size and allocate a buffer */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen read_size = ((ds_hdr_t *)hbuf)->payload_len;
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "Memory allocation failed attempting "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen " to allocate %d bytes." DS_EOL, (int)msglen);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "ds@%lx: %s: message payload len %d" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* move message header into buffer */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* read in the message body */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((rv = ds_recv_msg(port, currp, &read_size)) != 0) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* validate the size of the message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: %s: invalid message length, "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), __func__, (DS_HDR_SZ + read_size),
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Send the message for processing, and store it
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * in the log. The memory is deallocated only when
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * the message is removed from the log.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* log the message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (void) ds_log_add_msg(DS_LOG_IN(port->id), msg, msglen);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (ds_sys_dispatch_func(ds_dispatch_event, devent)) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: error initiating "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* handle connection reset errors returned from ds_recv_msg */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: %s done" DS_EOL, PORTID(port), __func__);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "ds@%lx: dispatch_event: msg_type=%d" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (*ds_msg_handlers[hdr->msg_type])(port, event->buf,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: dispatch_event: invalid msg "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "type (%d)" DS_EOL, PORTID(port), hdr->msg_type);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_send_msg(ds_port_t *port, caddr_t msg, size_t msglen)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%lx: %s msglen: %ld" DS_EOL, PORTID(port),
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen (void) ds_log_add_msg(DS_LOG_OUT(port->id), (uint8_t *)msg, msglen);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Ensure that no other messages can be sent on this port by holding
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * the tx_lock mutex in case the write doesn't get sent with one write.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * This guarantees that the message doesn't become fragmented.
beba1dd881728e806abb8621851ae851da168a08Mike Christensen rv = ldc_write(port->ldc.hdl, currp, &msglen);
da42b56a9a91df0c475186f2afad543f96a05019Mike Christensen (void) ds_sys_dispatch_func((void (*)(void *))
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen "ldc_write failed (%d), %d bytes "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen } while (amt_left > 0);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen/* END LDC SUPPORT FUNCTIONS */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen/* BEGIN DS PROTOCOL SUPPORT FUNCTIONS */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_handle_init_req(ds_port_t *port, caddr_t buf, size_t len)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* sanity check the incoming message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <init_req: invalid message "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "length (%ld), expected %ld" DS_EOL, PORTID(port), len,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <init_req: ver=%d.%d" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), req->major_vers, req->minor_vers);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen match = negotiate_version(DS_NUM_VER, &ds_vers[0],
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Check version info. ACK only if the major numbers exactly
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * match. The service entity can retry with a new minor
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * based on the response sent as part of the NACK.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen ack->minor_vers = MIN(new_minor, req->minor_vers);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: init_ack>: minor=0x%04X" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), MIN(new_minor, req->minor_vers));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen hdr->payload_len = sizeof (ds_init_nack_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen nack = (ds_init_nack_t *)(msg + DS_HDR_SZ);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: init_nack>: major=0x%04X" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Send the response
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen ds_set_port_ready(port, req->major_vers, ack->minor_vers);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_handle_init_ack(ds_port_t *port, caddr_t buf, size_t len)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* sanity check the incoming message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <init_ack: invalid message "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "length (%ld), expected %ld" DS_EOL, PORTID(port), len,
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <init_ack: port ready" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <init_ack: invalid state: %d"
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <init_ack: port ready v%d.%d" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_handle_init_nack(ds_port_t *port, caddr_t buf, size_t len)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen size_t explen = DS_MSG_LEN(ds_init_nack_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* sanity check the incoming message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_WARN, "ds@%lx: <init_nack: invalid message "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "length (%ld), expected %ld" DS_EOL, PORTID(port), len,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen nack = (ds_init_nack_t *)(buf + DS_HDR_SZ);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <init_nack: invalid state: %d"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <init_nack: req=v%d.%d, nack=v%d.x"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), ver->major, ver->minor, nack->major_vers);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* no supported protocol version */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_WARN, "ds@%lx: <init_nack: DS not supported"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Walk the version list, looking for a major version
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * that is as close to the requested major version as
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen for (idx = port->ver_idx; idx < DS_NUM_VER; idx++) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (ds_vers[idx].major <= nack->major_vers) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* found a version to try */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* no supported version */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_WARN, "ds@%lx: <init_nack: DS v%d.x not "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "supported" DS_EOL, PORTID(port), nack->major_vers);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* start the handshake again */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_find_svc_by_id_port(char *svc_id, int is_client, ds_port_t *port)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen uint32_t flag_match = is_client ? DSSF_ISCLIENT : 0;
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* walk every table entry */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen for (idx = 0; idx < ds_svcs.maxsvcs; idx++) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((svc->flags & DSSF_ISCLIENT) != flag_match)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen } else if (svc->state == DS_SVC_INACTIVE) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_handle_reg_req(ds_port_t *port, caddr_t buf, size_t len)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* sanity check the incoming message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <reg_req: invalid message "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "length (%ld), expected at least %ld" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <reg_req: '%s' ver=%d.%d, hdl=0x%llx"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), req->svc_id, req->major_vers, req->minor_vers,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_HDL_ISCLIENT(req->svc_handle) == 0, port);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: reg_nack>: '%s'" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Send the response
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <reg_req: '%s' found, hdl: 0x%llx" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), req->svc_id, (u_longlong_t)svc->hdl);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * A client sends out a reg req in order to force service providers to
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen * initiate a reg req from their end (limitation in the protocol). We
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen * expect the service provider to be in the inactive (DS_SVC_INACTIVE)
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen * state. If the service provider has already sent out a reg req (the
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen * state is DS_SVC_REG_PENDING) or has already handshaken (the
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen * state is DS_SVC_ACTIVE), then we can simply ignore this reg
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen * req. For any other state, we force an unregister before initiating
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <reg_req: '%s' pinging "
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <reg_req: '%s' pinging "
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen "client" DS_EOL, PORTID(port), req->svc_id);
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <reg_req: '%s' pinging "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Only remote service providers can initiate a registration. The
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * local sevice from here must be a client service.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen match = negotiate_version(svc->cap.nvers, svc->cap.vers,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Check version info. ACK only if the major numbers exactly
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * match. The service entity can retry with a new minor
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * based on the response sent as part of the NACK.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <reg_req: '%s' svc%d: state: %x "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "svc_portid: %d" DS_EOL, PORTID(port), req->svc_id,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (int)(svc->port == NULL ? -1 : PORTID(svc->port)));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * If the current local service is already in use and
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * it's not on this port, clone it.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (svc->port != NULL && port == svc->port) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Someone probably dropped an unreg req
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * somewhere. Force a local unreg.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Can't clone a non-client (service provider)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * handle. This is because old in-kernel
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * service providers can't deal with multiple
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen ack->minor_vers = MIN(new_minor, req->minor_vers);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* Call the registration callback */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (*svc->ops.ds_reg_cb)(svc->ops.cb_arg, &version,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: reg_ack>: '%s' minor=0x%04X"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: reg_nack>: '%s' major=0x%04X"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), svc->cap.svc_id, new_major);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* send message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_handle_reg_ack(ds_port_t *port, caddr_t buf, size_t len)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* sanity check the incoming message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <reg_ack: invalid message "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "length (%ld), expected %ld" DS_EOL, PORTID(port), len,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * This searches for service based on how we generate handles
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * and so only works because this is a reg ack.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (svc = ds_get_svc(ack->svc_handle)) == NULL) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <reg_ack: invalid handle 0x%llx"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), (u_longlong_t)ack->svc_handle);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* make sure the message makes sense */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <reg_ack: invalid state (%d)" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* major version has been agreed upon */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Use the minor version specified in the
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * original request.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Use the lower minor version returned in
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * the ack. By defninition, all lower minor
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * versions must be supported.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <reg_ack: '%s' v%d.%d ready, hdl=0x%llx"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), svc->cap.svc_id, svc->ver.major,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* notify the client that registration is complete */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Use a temporary version structure so that
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * the copy in the svc structure cannot be
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * modified by the client.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (*svc->ops.ds_reg_cb)(svc->ops.cb_arg, &tmpver, svc->hdl);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%x %s" DS_EOL, portid, __func__);
3ef557bf6acbaf0905479800b87d010f8715a11eMike Christensen * Get the ports that haven't been tried yet and are available to try.
3ef557bf6acbaf0905479800b87d010f8715a11eMike Christensen for (i = 0; i < DS_MAX_PORTS; i++) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen for (i = 0; i < DS_MAX_PORTS; i++, portid++) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * If the port is not in the available list,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * it is not a candidate for registration.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%x: %s trying ldc.id: %d" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%x: %s reg msg send OK" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* register sent successfully */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LDC(CE_NOTE, "ds@%x: %s reg msg send FAIL" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* reset the service to try the next port */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_handle_reg_nack(ds_port_t *port, caddr_t buf, size_t len)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* sanity check the incoming message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <reg_nack: invalid message "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "length (%ld), expected %ld" DS_EOL, PORTID(port), len,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * We expect a reg_nack for a client ping.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <reg_nack: ping hdl: 0x%llx"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), (u_longlong_t)nack->svc_handle);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * This searches for service based on how we generate handles
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * and so only works because this is a reg nack.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((svc = ds_get_svc(nack->svc_handle)) == NULL) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <reg_nack: invalid handle 0x%llx"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), (u_longlong_t)nack->svc_handle);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* make sure the message makes sense */
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <reg_nack: '%s' handle: 0x%llx "
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen "invalid state (%d)" DS_EOL, PORTID(port), svc->cap.svc_id,
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen (u_longlong_t)nack->svc_handle, svc->state);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <reg_nack: duplicate registration "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen " for %s" DS_EOL, PORTID(port), svc->cap.svc_id);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * A major version of zero indicates that the
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * service is not supported at all.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <reg_nack: '%s' not supported"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <reg_nack: '%s' hdl=0x%llx, nack=%d.x"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (u_longlong_t)nack->svc_handle, nack->major_vers);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Walk the version list for the service, looking for
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * a major version that is as close to the requested
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * major version as possible.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen for (idx = svc->ver_idx; idx < svc->cap.nvers; idx++) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (svc->cap.vers[idx].major <= nack->major_vers) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* found a version to try */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* no supported version */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <reg_nack: %s v%d.x not supported"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), svc->cap.svc_id, nack->major_vers);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* start the handshake again */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_handle_unreg_req(ds_port_t *port, caddr_t buf, size_t len)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen size_t explen = DS_MSG_LEN(ds_unreg_req_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* sanity check the incoming message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <unreg_req: invalid message "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "length (%ld), expected %ld" DS_EOL, PORTID(port), len,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* lookup appropriate client or service */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen ((svc = ds_find_clnt_svc_by_hdl_port(req->svc_handle, port))
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen == NULL && ((svc = ds_get_svc(req->svc_handle)) == NULL ||
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <unreg_req: invalid handle 0x%llx"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), (u_longlong_t)req->svc_handle);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <unreg_req: '%s' handle 0x%llx" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), svc->cap.svc_id, (u_longlong_t)req->svc_handle);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: unreg_ack>: '%s' hdl=0x%llx" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), svc->cap.svc_id, (u_longlong_t)req->svc_handle);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen msglen = DS_HDR_SZ + sizeof (ds_unreg_ack_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen hdr->payload_len = sizeof (ds_unreg_ack_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* send message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_handle_unreg_ack(ds_port_t *port, caddr_t buf, size_t len)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen size_t explen = DS_MSG_LEN(ds_unreg_ack_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* sanity check the incoming message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <unreg_ack: invalid message "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "length (%ld), expected %ld" DS_EOL, PORTID(port), len,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <unreg_ack: hdl=0x%llx" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), (u_longlong_t)ack->svc_handle);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Since the unregister request was initiated locally,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * the service structure has already been torn down.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Just perform a sanity check to make sure the message
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * is appropriate.
b1ad746c0fd685d32c55d17a53c097d8eefbfd11Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <unreg_ack: handle 0x%llx in use"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), (u_longlong_t)ack->svc_handle);
b1ad746c0fd685d32c55d17a53c097d8eefbfd11Mike Christensen#endif /* DEBUG */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_handle_unreg_nack(ds_port_t *port, caddr_t buf, size_t len)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen size_t explen = DS_MSG_LEN(ds_unreg_nack_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* sanity check the incoming message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <unreg_nack: invalid message "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "length (%ld), expected %ld" DS_EOL, PORTID(port), len,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen nack = (ds_unreg_nack_t *)(buf + DS_HDR_SZ);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <unreg_nack: hdl=0x%llx" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), (u_longlong_t)nack->svc_handle);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Since the unregister request was initiated locally,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * the service structure has already been torn down.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Just perform a sanity check to make sure the message
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * is appropriate.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (ds_get_svc(nack->svc_handle) != NULL) {
b1ad746c0fd685d32c55d17a53c097d8eefbfd11Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <unreg_nack: handle 0x%llx in use"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), (u_longlong_t)nack->svc_handle);
b1ad746c0fd685d32c55d17a53c097d8eefbfd11Mike Christensen#endif /* DEBUG */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_handle_data(ds_port_t *port, caddr_t buf, size_t len)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen size_t explen = DS_MSG_LEN(ds_data_handle_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* sanity check the incoming message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <data: invalid message length "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "(%ld), expected at least %ld" DS_EOL, PORTID(port), len,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen data = (ds_data_handle_t *)(buf + DS_HDR_SZ);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen hdrsz = DS_HDR_SZ + sizeof (ds_data_handle_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* strip off the header for the client */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((svc = ds_find_clnt_svc_by_hdl_port(data->svc_handle, port))
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((svc = ds_get_svc(data->svc_handle)) == NULL) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <data: invalid handle 0x%llx"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: <data: '%s' hdl=0x%llx" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), svc->cap.svc_id, (u_longlong_t)svc->hdl);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* dispatch this message to the client */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (*svc->ops.ds_data_cb)(svc->ops.cb_arg, msg, msgsz);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_handle_nack(ds_port_t *port, caddr_t buf, size_t len)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen size_t explen = DS_MSG_LEN(ds_data_nack_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* sanity check the incoming message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <data_nack: invalid message "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "length (%ld), expected %ld" DS_EOL, PORTID(port), len,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen nack = (ds_data_nack_t *)(buf + DS_HDR_SZ);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: data_nack: hdl=0x%llx, result=0x%llx"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), (u_longlong_t)nack->svc_handle,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((svc = ds_find_clnt_svc_by_hdl_port(nack->svc_handle,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((svc = ds_get_svc(nack->svc_handle)) == NULL) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: <data_nack: handle 0x%llx reported "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen/* Initialize the port */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: init_req>: invalid state: %d"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: init_req>: req=v%d.%d" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen msglen = DS_HDR_SZ + sizeof (ds_init_req_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen init_req = (ds_init_req_t *)((caddr_t)hdr + DS_HDR_SZ);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (ds_send_msg(port, (caddr_t)hdr, msglen) == 0) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * We've left the port state unlocked over the malloc/send,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * make sure no one has changed the state under us before
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * we update the state.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_send_reg_req(ds_svc_t *svc, ds_port_t *port)
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: reg_req>: invalid svc state (%d) "
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen "for svc '%s'" DS_EOL, PORTID(port), svc->state,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* check on the LDC to Zeus */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* can not send message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: reg_req>: channel %ld is not up"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* make sure port is ready */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* can not send message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: reg_req>: port is not ready"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* allocate the message buffer */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen msglen = DS_HDR_SZ + sizeof (ds_reg_req_t) + idlen;
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* copy in the header data */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen hdr->payload_len = sizeof (ds_reg_req_t) + idlen;
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* copy in the service id */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (void) memcpy(req->svc_id, svc->cap.svc_id, idlen + 1);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* send the message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: reg_req>: '%s' ver=%d.%d, hdl=0x%llx"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, PORTID(port), svc->cap.svc_id, ver->major, ver->minor,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((rv = ds_send_msg(port, msg, msglen)) != 0) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen } else if ((svc->flags & DSSF_ISCLIENT) == 0) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Keep around in case we want this later
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "send_unreg_req: service '%s' not "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "associated with a port" DS_EOL, svc->cap.svc_id);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* check on the LDC to Zeus */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* can not send message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: unreg_req>: channel %ld is not up"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* make sure port is ready */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* can not send message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: unreg_req>: port is not ready" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen msglen = DS_HDR_SZ + sizeof (ds_unreg_req_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* copy in the header data */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen hdr->payload_len = sizeof (ds_unreg_req_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* send the message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: unreg_req>: '%s' hdl=0x%llx" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), (svc->cap.svc_id) ? svc->cap.svc_id : "NULL",
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((rv = ds_send_msg(port, msg, msglen)) != 0) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_send_unreg_nack(ds_port_t *port, ds_svc_hdl_t bad_hdl)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* check on the LDC to Zeus */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* can not send message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: unreg_nack>: channel %ld is not up"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* make sure port is ready */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* can not send message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: unreg_nack>: port is not ready"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen msglen = DS_HDR_SZ + sizeof (ds_unreg_nack_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* copy in the header data */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen hdr->payload_len = sizeof (ds_unreg_nack_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen nack = (ds_unreg_nack_t *)(msg + DS_HDR_SZ);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* send the message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: unreg_nack>: hdl=0x%llx" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_send_data_nack(ds_port_t *port, ds_svc_hdl_t bad_hdl)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* check on the LDC to Zeus */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* can not send message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: data_nack>: channel %ld is not up"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* make sure port is ready */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* can not send message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "ds@%lx: data_nack>: port is not ready" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen msglen = DS_HDR_SZ + sizeof (ds_data_nack_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* copy in the header data */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen hdr->payload_len = sizeof (ds_data_nack_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen nack = (ds_data_nack_t *)(msg + DS_HDR_SZ);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* send the message */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: data_nack>: hdl=0x%llx" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen/* END DS PROTOCOL SUPPORT FUNCTIONS */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen#define LINEWIDTH ((BYTESPERLINE * 3) + (BYTESPERLINE + 2) + 1)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen#define ASCIIOFFSET ((BYTESPERLINE * 3) + 2)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen#define ISPRINT(c) ((c >= ' ') && (c <= '~'))
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Output a buffer formatted with a set number of bytes on
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * each line. Append each line with the ASCII equivalent of
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * each byte if it falls within the printable ASCII range,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * and '.' otherwise.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* walk the buffer one line at a time */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Walk the bytes in the current line, storing
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * the hex value for the byte as well as the
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * ASCII representation in a temporary buffer.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * All ASCII values are placed at the end of
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen for (j = 0; (j < BYTESPERLINE) && ((i + j) < len); j++) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen *aoff = (ISPRINT(buf[i + j])) ? buf[i + j] : '.';
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Fill in to the start of the ASCII translation
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * with spaces. This will only be necessary if
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * this is the last line and there are not enough
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * bytes to fill the whole line.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen#endif /* DEBUG */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Walk the table of registered services, executing the specified callback
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * function for each service on a port. A non-zero return value from the
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * callback is used to terminate the walk, not to indicate an error. Returns
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * the index of the last service visited.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* walk every table entry */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen for (idx = 0; idx < ds_svcs.maxsvcs; idx++) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* execute the callback */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Looking for a free service. This may be a NULL entry
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * in the table, or an unused structure that could be
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* yes, it is free */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* not a candidate */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* found a match */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_svc_clnt_ismatch(ds_svc_t *svc, void *arg)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* found a match */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_FREE(svc->cap.svc_id, strlen(svc->cap.svc_id) + 1);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_FREE(svc->cap.vers, svc->cap.nvers * sizeof (ds_ver_t));
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensends_set_svc_port_tried(char *svc_id, ds_port_t *port)
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen /* walk every table entry */
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen for (idx = 0; idx < ds_svcs.maxsvcs; idx++) {
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen if (!DS_SVC_ISFREE(svc) && (svc->flags & DSSF_ISCLIENT) != 0 &&
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_svc_register_onport(ds_svc_t *svc, ds_port_t *port)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (!DS_PORT_IN_SET(svc->avail, PORTID(port)))
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen if (DS_PORT_IN_SET(svc->tried, PORTID(port)))
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen ds_set_svc_port_tried(svc->cap.svc_id, port);
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen * Never send a client reg req to the SP.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* register sent successfully */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* reset the service */
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensends_svc_register_onport_walker(ds_svc_t *svc, void *arg)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Attempt to register the service. Start with the lowest
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * numbered port and continue until a registration message
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * is sent successfully, or there are no ports left to try.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * If the port is not in the available list,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * it is not a candidate for registration.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* make sure the service is using this port */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "ds@%lx: svc_unreg: id='%s', ver=%d.%d, "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen " hdl=0x%09lx" DS_EOL, PORTID(port), svc->cap.svc_id,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "port=NULL: svc_unreg: id='%s', ver=%d.%d, "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen " hdl=0x%09lx" DS_EOL, svc->cap.svc_id, svc->ver.major,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* reset the service structure */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* call the client unregister callback */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* increment the count in the handle to prevent reuse */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen hdl = DS_ALLOC_HDL(DS_HDL2IDX(svc->hdl), DS_HDL2COUNT(svc->hdl));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* try to initiate a new registration */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* nothing to do */
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensends_set_port_ready(ds_port_t *port, uint16_t major, uint16_t minor)
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen was_ready = (port->state == DS_PORT_READY);
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen * The port came up, so update all the services
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen * with this information. Follow that up with an
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen * attempt to register any service that is not
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen * already registered.
ffc2bef081c0f7e604532873017ff27025cd46aeMike Christensen (void) ds_walk_svcs(ds_svc_register_onport_walker, port);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * There was no free space in the table. Grow
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * the table to double its current size.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen newtbl = DS_MALLOC(newmaxsvcs * sizeof (ds_svc_t *));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* copy old table data to the new table */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* clean up the old table */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_FREE(ds_svcs.tbl, ds_svcs.maxsvcs * sizeof (ds_svc_t *));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* search for a free space again */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* the table is locked so should find a free slot */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* allocate a new svc structure if necessary */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* allocate a new service */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* fill in the handle */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen newsvc->hdl = DS_ALLOC_HDL(idx, DS_HDL2COUNT(newsvc->hdl));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen newsvc->state = DS_SVC_FREE; /* Mark as free temporarily */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_reset_svc(ds_svc_t *svc, ds_port_t *port)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* check if index is out of bounds */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* check for a valid service */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* make sure the handle is an exact match */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* connection went down, mark everything inactive */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (void) ds_walk_svcs(ds_svc_unregister, port);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Verify that a version array is sorted as expected for the
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * version negotiation to work correctly.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Walk the version array, verifying correct ordering.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * The array must be sorted from highest supported
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * version to lowest supported version.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "ds_vers_isvalid: version array has "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "ds_vers_isvalid: version array has "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Extended user capability init.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_ucap_init(ds_capability_t *cap, ds_clnt_ops_t *ops, uint32_t flags,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* sanity check the args */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_NOTE, "%s: invalid arguments" DS_EOL, __func__);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* sanity check the capability specifier */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((cap->svc_id == NULL) || (cap->vers == NULL) || (cap->nvers == 0)) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_NOTE, "%s: invalid capability specifier" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* sanity check the version array */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((status = ds_vers_isvalid(cap->vers, cap->nvers)) != DS_VERS_OK) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_NOTE, "%s: invalid capability version array "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "for %s service: %s" DS_EOL, __func__, cap->svc_id,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "increasing major versions" :
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "increasing minor versions");
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* data and register callbacks are required */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((ops->ds_data_cb == NULL) || (ops->ds_reg_cb == NULL)) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_NOTE, "%s: invalid ops specifier for %s service"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_USR(CE_NOTE, "%s: svc_id='%s', data_cb=0x%lx, cb_arg=0x%lx"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_EOL, __func__, cap->svc_id, PTR_TO_LONG(ops->ds_data_cb),
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* check if the service is already registered */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (i_ds_hdl_lookup(cap->svc_id, is_client, NULL, 1) == 1) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* already registered */
e9406929914976efdccb875f94e90e85cdb076e3Mike Christensen DS_DBG_USR(CE_NOTE, "Service '%s'/%s already registered" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (flags & DSSF_ISCLIENT) ? "client" : "service");
f4b11d030c994c1de099f1a482ffc7c709a0aaa1Mike Christensen * Check for loopback. "pri" is a legacy service that assumes it
f4b11d030c994c1de099f1a482ffc7c709a0aaa1Mike Christensen * will never use loopback mode.
f4b11d030c994c1de099f1a482ffc7c709a0aaa1Mike Christensen } else if (i_ds_hdl_lookup(cap->svc_id, is_client == 0, &lb_hdl, 1)
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen if ((rv = ds_loopback_set_svc(svc, cap, &lb_hdl)) != 0) {
f4b11d030c994c1de099f1a482ffc7c709a0aaa1Mike Christensen DS_DBG_USR(CE_NOTE, "%s: ds_loopback_set_svc '%s' err "
f4b11d030c994c1de099f1a482ffc7c709a0aaa1Mike Christensen " (%d)" DS_EOL, __func__, cap->svc_id, rv);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* copy over all the client information */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (void) memcpy(&svc->cap, cap, sizeof (ds_capability_t));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* make a copy of the service name */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* make a copy of the version array */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen svc->cap.vers = DS_MALLOC(cap->nvers * sizeof (ds_ver_t));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (void) memcpy(svc->cap.vers, cap->vers, cap->nvers * sizeof (ds_ver_t));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* copy the client ops vector */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (void) memcpy(&svc->ops, ops, sizeof (ds_clnt_ops_t));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * kludge to allow user callback code to get handle and user args.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Make sure the callback arg points to the svc structure.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * If this is a client or a non-loopback service provider, send
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * out register requests.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (!is_loopback || (flags & DSSF_ISCLIENT) != 0)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_USR(CE_NOTE, "%s: service '%s' assigned handle 0x%09lx" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * ds_cap_init interface for previous revision.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_cap_init(ds_capability_t *cap, ds_clnt_ops_t *ops)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen return (ds_ucap_init(cap, ops, 0, DS_INVALID_INSTANCE, NULL));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Interface for ds_unreg_hdl in lds driver.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_USR(CE_NOTE, "%s: hdl=0x%09lx" DS_EOL, __func__, hdl);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_USR(CE_NOTE, "%s: unknown hdl: 0x%llx" DS_EOL, __func__,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_USR(CE_NOTE, "%s: svcid='%s', hdl=0x%llx" DS_EOL, __func__,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen is_loopback = ((svc->flags & DSSF_LOOPBACK) != 0);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "%s: '%s'" DS_EOL, __func__, cap->svc_id);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((rv = ds_hdl_lookup(cap->svc_id, 0, &hdl, 1, &nhdls)) != 0) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "%s: ds_hdl_lookup '%s' err (%d)" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "%s: no such service '%s'" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((rv = ds_is_my_hdl(hdl, DS_INVALID_INSTANCE)) != 0) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "%s: ds_is_my_handle err (%d)" DS_EOL, __func__,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "%s: ds_unreg_hdl err (%d)" DS_EOL, __func__,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_cap_send(ds_svc_hdl_t hdl, void *buf, size_t len)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "%s: hdl: 0x%llx, buf: %lx, len: %ld" DS_EOL, __func__,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen cmn_err(CE_WARN, "%s: invalid handle 0x%llx" DS_EOL, __func__,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* channel is up, but svc is not registered */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "%s: invalid service state 0x%x" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "%s: service '%s' not associated with a port"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* check that the LDC channel is ready */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "%s: LDC channel is not up" DS_EOL, __func__);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen hdrlen = DS_HDR_SZ + sizeof (ds_data_handle_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen hdr->payload_len = len + sizeof (ds_data_handle_t);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen data = (ds_data_handle_t *)(msg + DS_HDR_SZ);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: data>: hdl=0x%llx, len=%ld, "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen " payload_len=%d" DS_EOL, PORTID(port), (u_longlong_t)svc->hdl,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DUMP_MSG(DS_DBG_FLAG_PRCL, msg, msglen);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((rv = ds_send_msg(port, msg, msglen)) != 0) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((port->flags & DS_PORT_MUTEX_INITED) == 0) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen mutex_init(&port->lock, NULL, MUTEX_DRIVER, NULL);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen mutex_init(&port->tx_lock, NULL, MUTEX_DRIVER, NULL);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen mutex_init(&port->rcv_lock, NULL, MUTEX_DRIVER, NULL);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * If LDC successfully init'ed, try to kick off protocol for this port.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Initialize table of registered service classes
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen tblsz = ds_svcs.maxsvcs * sizeof (ds_svc_t *);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen ds_svcs.tbl = (ds_svc_t **)DS_MALLOC(tblsz);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Find the max and min version supported.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Hacked from zeus workspace, support.c
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenmin_max_versions(int num_versions, ds_ver_t *sup_versionsp,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Check whether the major and minor numbers requested by the peer can be
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * satisfied. If the requested major is supported, true is returned, and the
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * agreed minor is returned in new_minor. If the requested major is not
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * supported, the routine returns false, and the closest major is returned in
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * *new_major, upon which the peer should re-negotiate. The closest major is
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * the just lower that the requested major number.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Hacked from zeus workspace, support.c
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensennegotiate_version(int num_versions, ds_ver_t *sup_versionsp,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen uint16_t req_major, uint16_t *new_majorp, uint16_t *new_minorp)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen min_max_versions(num_versions, sup_versionsp, &min_major, &max_major);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG(CE_NOTE, "negotiate_version: req_major = %u, min = %u, max = %u"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * If the minimum version supported is greater than
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * the version requested, return the lowest version
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * If the largest version supported is lower than
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * the version requested, return the largest version
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Now we know that the requested version lies between the
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * min and max versions supported. Check if the requested
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * major can be found in supported versions.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen for (i = 0; i < num_versions; i++) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((major < req_major) && (major > lower_major))
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * If no match is found, return the closest available number
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Specific errno's that are used by ds.c and ldc.c
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensenstatic struct {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen { EAGAIN, "Resource temporarily unavailable" },
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen { ECONNRESET, "Connection reset by peer" },
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen { EALREADY, "Operation already in progress" },
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen for (i = 0; (en = ds_errno_to_str_tab[i].ds_errno) != 0; i++) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (void) strcpy(ebuf, ds_errno_to_str_tab[i].estr);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (void) sprintf(ebuf, "ds_errno (%d)", ds_errno);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LOOP(CE_NOTE, "%s: entered hdl: 0x%llx" DS_EOL, __func__,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LOOP(CE_NOTE, "%s: invalid hdl: 0x%llx" DS_EOL, __func__,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LOOP(CE_NOTE, "%s: loopback regcb: hdl: 0x%llx" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (*svc->ops.ds_reg_cb)(svc->ops.cb_arg, &ds_ver, hdl);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LOOP(CE_NOTE, "%s: invalid hdl: 0x%llx" DS_EOL, __func__,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LOOP(CE_NOTE, "%s: entered hdl: 0x%llx" DS_EOL, __func__,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LOOP(CE_NOTE, "%s: loopback unregcb: hdl: 0x%llx" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_loopback_send(ds_svc_hdl_t hdl, void *buf, size_t buflen)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LOOP(CE_NOTE, "%s: invalid hdl: 0x%llx" DS_EOL, __func__,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LOOP(CE_NOTE, "%s: entered hdl: 0x%llx" DS_EOL, __func__,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LOOP(CE_NOTE, "%s: loopback datacb hdl: 0x%llx" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (*svc->ops.ds_data_cb)(svc->ops.cb_arg, buf, buflen);
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensends_loopback_set_svc(ds_svc_t *svc, ds_capability_t *cap, ds_svc_hdl_t *lb_hdlp)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((lb_svc = ds_get_svc(lb_hdl)) == NULL) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LOOP(CE_NOTE, "%s: loopback: hdl: 0x%llx invalid" DS_EOL,
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen /* negotiate a version between loopback services, if possible */
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen for (i = 0; i < lb_svc->cap.nvers && match == 0; i++) {
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen match = negotiate_version(cap->nvers, cap->vers,
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen lb_svc->cap.vers[i].major, &new_major, &new_minor);
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen DS_DBG_LOOP(CE_NOTE, "%s: loopback version negotiate failed"
bca70f54b47e1896668cd05d64cdf448a9582d74Mike Christensen * If a client service is not inactive, clone it. If the service is
bca70f54b47e1896668cd05d64cdf448a9582d74Mike Christensen * not a client service and has a reg req pending (usually from OBP
bca70f54b47e1896668cd05d64cdf448a9582d74Mike Christensen * in boot state not acking/nacking reg req's), it's OK to ignore that,
bca70f54b47e1896668cd05d64cdf448a9582d74Mike Christensen * since there are never multiple service clients. Also reg req pending
bca70f54b47e1896668cd05d64cdf448a9582d74Mike Christensen * only happens for non-client services, so it's OK to skip
bca70f54b47e1896668cd05d64cdf448a9582d74Mike Christensen * this block that does client service cloning.
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen DS_DBG_LOOP(CE_NOTE, "%s: loopback active: hdl: 0x%llx"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if ((lb_svc->flags & DSSF_ISCLIENT) == 0) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LOOP(CE_NOTE, "%s: loopback busy hdl: 0x%llx"
a600f50d43405fe4fd9ab16cc92b28df19656392Mike Christensen svc->state = DS_SVC_INACTIVE; /* prevent alloc'ing svc */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LOOP(CE_NOTE, "%s: loopback clone: ohdl: 0x%llx "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "nhdl: 0x%llx" DS_EOL, __func__, (u_longlong_t)lb_hdl,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_LOOP(CE_NOTE, "%s: setting loopback between: 0x%llx and 0x%llx"
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_find_clnt_svc_by_hdl_port(ds_svc_hdl_t hdl, ds_port_t *port)
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: %s looking up clnt hdl: 0x%llx" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), __func__, (u_longlong_t)hdl);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* walk every table entry */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen for (idx = 0; idx < ds_svcs.maxsvcs; idx++) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen svc->svc_hdl == hdl && svc->port == port) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: %s found clnt hdl "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "0x%llx: svc%d" DS_EOL, PORTID(port), __func__,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (u_longlong_t)hdl, (uint_t)DS_HDL2IDX(svc->hdl));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_PRCL(CE_NOTE, "ds@%lx: %s clnt hdl: 0x%llx not found" DS_EOL,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen PORTID(port), __func__, (u_longlong_t)hdl);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* Can only clone clients for now */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_DBG_USR(CE_NOTE, "%s: cloning client: old hdl: 0x%llx new hdl: "
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen "0x%llx" DS_EOL, __func__, (u_longlong_t)svc->hdl,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (void) memcpy(newsvc, svc, sizeof (ds_svc_t));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen newsvc->cap.svc_id = ds_strdup(svc->cap.svc_id);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen newsvc->cap.vers = DS_MALLOC(svc->cap.nvers * sizeof (ds_ver_t));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (void) memcpy(newsvc->cap.vers, svc->cap.vers,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Kludge to allow lds driver user callbacks to get access to current
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * svc structure. Arg could be index to svc table or some other piece
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * of info to get to the svc table entry.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen newsvc->ops.cb_arg = (ds_cb_arg_t)(newsvc);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Internal handle lookup function.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christenseni_ds_hdl_lookup(char *service, uint_t is_client, ds_svc_hdl_t *hdlp,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen uint32_t client_flag = is_client ? DSSF_ISCLIENT : 0;
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen for (idx = 0; idx < ds_svcs.maxsvcs && nhdls < maxhdls; idx++) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen if (strcmp(svc->cap.svc_id, service) == 0 &&
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen (svc->flags & DSSF_ISCLIENT) == client_flag) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Interface for ds_hdl_lookup in lds driver.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensends_hdl_lookup(char *service, uint_t is_client, ds_svc_hdl_t *hdlp,
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen *nhdlsp = i_ds_hdl_lookup(service, is_client, hdlp, maxhdls);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * After an UNREG REQ, check if this is a client service with multiple
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * handles. If it is, then we can eliminate this entry.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen i_ds_hdl_lookup(svc->cap.svc_id, 1, NULL, 2) == 2) {
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * Clear out the structure, but do not deallocate the
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen * memory. It can be reused for the next registration.
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_FREE(svc->cap.svc_id, strlen(svc->cap.svc_id) + 1);
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen DS_FREE(svc->cap.vers, svc->cap.nvers * sizeof (ds_ver_t));
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* save the handle to prevent reuse */
30588217a56ff2c9137248fb2e5065c4f0101459Mike Christensen /* initialize for next use */