1c42de6d020629af774dd9e9fc81be3f3ed9398egd/*
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * CDDL HEADER START
1c42de6d020629af774dd9e9fc81be3f3ed9398egd *
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * The contents of this file are subject to the terms of the
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * Common Development and Distribution License (the "License").
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * You may not use this file except in compliance with the License.
1c42de6d020629af774dd9e9fc81be3f3ed9398egd *
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * or http://www.opensolaris.org/os/licensing.
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * See the License for the specific language governing permissions
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * and limitations under the License.
1c42de6d020629af774dd9e9fc81be3f3ed9398egd *
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * When distributing Covered Code, include this CDDL HEADER in each
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * If applicable, add the following below this CDDL HEADER, with the
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * fields enclosed by brackets "[]" replaced with your own identifying
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * information: Portions Copyright [yyyy] [name of copyright owner]
1c42de6d020629af774dd9e9fc81be3f3ed9398egd *
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * CDDL HEADER END
1c42de6d020629af774dd9e9fc81be3f3ed9398egd */
1c42de6d020629af774dd9e9fc81be3f3ed9398egd/*
88294e09b5c27cbb12b6735e2fb247a86b76666dRichard Bean * Copyright 2008 Sun Microsystems, Inc. All rights reserved.
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * Use is subject to license terms.
1c42de6d020629af774dd9e9fc81be3f3ed9398egd */
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd/*
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * Safari Configurator (gptwocfg)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd *
1c42de6d020629af774dd9e9fc81be3f3ed9398egd */
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/types.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/cred.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/mman.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/kmem.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/conf.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/cmn_err.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/ddi.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/sunddi.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/sunndi.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/modctl.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/stat.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/param.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/autoconf.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/ksynch.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/promif.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/ndi_impldefs.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/ddi_impldefs.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/gp2cfg.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/machsystm.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#include <sys/platform_module.h>
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#pragma weak starcat_dr_name
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#ifdef DEBUG
1c42de6d020629af774dd9e9fc81be3f3ed9398egdint gptwocfg_debug = 0;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdstatic void debug(char *, uintptr_t, uintptr_t,
1c42de6d020629af774dd9e9fc81be3f3ed9398egd uintptr_t, uintptr_t, uintptr_t);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#define GPTWO_DEBUG0(level, flag, s) if (gptwocfg_debug >= level) \
1c42de6d020629af774dd9e9fc81be3f3ed9398egd cmn_err(flag, s)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#define GPTWO_DEBUG1(level, flag, fmt, a1) if (gptwocfg_debug >= level) \
1c42de6d020629af774dd9e9fc81be3f3ed9398egd debug(fmt, (uintptr_t)(a1), 0, 0, 0, 0);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#define GPTWO_DEBUG2(level, flag, fmt, a1, a2) if (gptwocfg_debug >= level) \
1c42de6d020629af774dd9e9fc81be3f3ed9398egd debug(fmt, (uintptr_t)(a1), (uintptr_t)(a2), 0, 0, 0);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#define GPTWO_DEBUG3(level, flag, fmt, a1, a2, a3) \
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (gptwocfg_debug >= level) \
1c42de6d020629af774dd9e9fc81be3f3ed9398egd debug(fmt, (uintptr_t)(a1), (uintptr_t)(a2), (uintptr_t)(a3), 0, 0);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#else
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#define GPTWO_DEBUG0(level, flag, s)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#define GPTWO_DEBUG1(level, flag, fmt, a1)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#define GPTWO_DEBUG2(level, flag, fmt, a1, a2)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#define GPTWO_DEBUG3(level, flag, fmt, a1, a2, a3)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#endif
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdkmutex_t gptwo_handle_list_lock;
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwocfg_handle_list_t *gptwocfg_handle_list;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdstatic kmutex_t gptwo_config_list_lock;
1c42de6d020629af774dd9e9fc81be3f3ed9398egdstatic gptwocfg_config_t *gptwo_config_list;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdstatic gptwo_new_nodes_t *
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_get_obp_created_nodes(dev_info_t *, uint_t);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdvoid (*gptwocfg_unclaim_address)(uint_t);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdextern caddr_t efcode_vaddr;
1c42de6d020629af774dd9e9fc81be3f3ed9398egdextern int efcode_size;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#define GPTWO_NUMBER_OF_DEVICE_TYPES 6
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdstatic kmutex_t gptwocfg_ops_table_lock;
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwocfg_ops_t *gptwocfg_ops_table[GPTWO_NUMBER_OF_DEVICE_TYPES];
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd/*
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * Module linkage information for the kernel.
1c42de6d020629af774dd9e9fc81be3f3ed9398egd */
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdextern struct mod_ops mod_miscops;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdstatic struct modlmisc modlmisc = {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd &mod_miscops, /* Type of module */
88294e09b5c27cbb12b6735e2fb247a86b76666dRichard Bean "gptwo configurator",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd};
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdstatic struct modlinkage modlinkage = {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd MODREV_1, (void *)&modlmisc, NULL
1c42de6d020629af774dd9e9fc81be3f3ed9398egd};
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdint
1c42de6d020629af774dd9e9fc81be3f3ed9398egd_init(void)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd{
1c42de6d020629af774dd9e9fc81be3f3ed9398egd unsigned int i;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG0(1, CE_WARN, "gptwocfg (Safari Configurator) "
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "has been loaded\n");
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_init(&gptwo_config_list_lock, NULL, MUTEX_DRIVER, NULL);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_init(&gptwocfg_ops_table_lock, NULL, MUTEX_DRIVER, NULL);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwo_config_list = NULL;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_init(&gptwo_handle_list_lock, NULL, MUTEX_DRIVER, NULL);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_handle_list = NULL;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd for (i = 0; i < GPTWO_NUMBER_OF_DEVICE_TYPES; i++)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_ops_table[i] = NULL;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (mod_install(&modlinkage));
1c42de6d020629af774dd9e9fc81be3f3ed9398egd}
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdint
1c42de6d020629af774dd9e9fc81be3f3ed9398egd_fini(void)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd{
1c42de6d020629af774dd9e9fc81be3f3ed9398egd int error;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd error = mod_remove(&modlinkage);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (error != 0) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (error);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_destroy(&gptwo_config_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_destroy(&gptwocfg_ops_table_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_destroy(&gptwo_handle_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (0);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd}
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdint
1c42de6d020629af774dd9e9fc81be3f3ed9398egd_info(modinfop)
1c42de6d020629af774dd9e9fc81be3f3ed9398egdstruct modinfo *modinfop;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd{
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (mod_info(&modlinkage, modinfop));
1c42de6d020629af774dd9e9fc81be3f3ed9398egd}
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwo_new_nodes_t *
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwocfg_allocate_node_list(int number_of_nodes)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd{
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwo_new_nodes_t *gptwo_new_nodes;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd int size;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_CONT, "gptwocfg_allocate_node_list- %d nodes",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd number_of_nodes);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd size = sizeof (gptwo_new_nodes_t) +
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ((number_of_nodes -1) * sizeof (dev_info_t *));
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwo_new_nodes = kmem_zalloc(size, KM_SLEEP);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwo_new_nodes->gptwo_number_of_nodes = number_of_nodes;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwo_new_nodes->gptwo_version = GP2_VERSION;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_CONT, "gptwocfg_allocate_node_list- returned %p\n",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwo_new_nodes);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (gptwo_new_nodes);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd}
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdvoid
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwocfg_free_node_list(gptwo_new_nodes_t *gptwo_new_nodes)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd{
1c42de6d020629af774dd9e9fc81be3f3ed9398egd int size;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG2(1, CE_CONT, "gptwocfg_free_node_list- %p %d nodes",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwo_new_nodes, gptwo_new_nodes->gptwo_number_of_nodes);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd size = sizeof (gptwo_new_nodes_t) +
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ((gptwo_new_nodes->gptwo_number_of_nodes - 1) *
1c42de6d020629af774dd9e9fc81be3f3ed9398egd sizeof (dev_info_t *));
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd kmem_free(gptwo_new_nodes, size);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd}
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdvoid
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwocfg_register_ops(uint_t type, gptwo_cfgfunc_t *cfg_func,
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwo_uncfgfunc_t *uncfg_func)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd{
1c42de6d020629af774dd9e9fc81be3f3ed9398egd /* KM_SLEEP guarantees success */
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_ops_t *ops = kmem_zalloc(sizeof (gptwocfg_ops_t), KM_SLEEP);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG2(1, CE_CONT, "gptwocfg_register_ops: type=%x ops=%lx\n",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd type, ops);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ASSERT(type < GPTWO_NUMBER_OF_DEVICE_TYPES);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ops->gptwocfg_type = type;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ops->gptwocfg_version = GPTWOCFG_OPS_VERSION;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ops->gptwocfg_configure = cfg_func;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ops->gptwocfg_unconfigure = uncfg_func;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_enter(&gptwocfg_ops_table_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_ops_table[type] = ops;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_exit(&gptwocfg_ops_table_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd}
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdvoid
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwocfg_unregister_ops(uint_t type)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd{
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_CONT, "gptwocfg_unregister_ops: type=%x\n", type);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ASSERT(type < GPTWO_NUMBER_OF_DEVICE_TYPES);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_enter(&gptwocfg_ops_table_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd kmem_free(gptwocfg_ops_table[type], sizeof (gptwocfg_ops_t));
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_ops_table[type] = NULL;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_exit(&gptwocfg_ops_table_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd}
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwocfg_cookie_t
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwocfg_configure(dev_info_t *ap, spcd_t *pcd, gptwo_aid_t id)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd{
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwo_new_nodes_t *new_nodes = NULL;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_config_t *config;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_ops_t *ops;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG3(1, CE_CONT, "gptwocfg_configure: ap=0x%p pcd=%p id=%x\n",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ap, pcd, id);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd /*
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * Look to see if the port is already configured.
1c42de6d020629af774dd9e9fc81be3f3ed9398egd */
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_enter(&gptwo_config_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config = gptwo_config_list;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd while (config != NULL) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (&starcat_dr_name) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (starcat_dr_name(ddi_node_name(ap)) < 0) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config = config->gptwo_next;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd continue;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (config->gptwo_portid == id) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd cmn_err(CE_WARN, "gptwocfg: gptwocfg_configure: "
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "0x%x Port already configured\n", id);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_exit(&gptwo_config_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (NULL);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config = config->gptwo_next;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_exit(&gptwo_config_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (pcd == NULL) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG0(1, CE_CONT, "gptwocfg_configure: pcd=NULL\n");
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (NULL);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if ((pcd->spcd_magic != PCD_MAGIC) ||
1c42de6d020629af774dd9e9fc81be3f3ed9398egd (pcd->spcd_version != PCD_VERSION)) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd cmn_err(CE_WARN, "gptwocfg: Invalid Port "
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "Configuration Descriptor\n");
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (NULL);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (pcd->spcd_ptype >= GPTWO_NUMBER_OF_DEVICE_TYPES) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd cmn_err(CE_WARN,
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "gptwocfg: Invalid device type %x", pcd->spcd_ptype);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (NULL);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (pcd->spcd_prsv != SPCD_RSV_PASS) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd cmn_err(CE_WARN,
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "gptwocfg: Agent at ID %x has not passed test(s)\n", id);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (NULL);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_enter(&gptwocfg_ops_table_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ops = gptwocfg_ops_table[pcd->spcd_ptype];
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (ops == NULL) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd cmn_err(CE_WARN, "gptwocfg: Ops for type %x have not been "
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "registered\n", pcd->spcd_ptype);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_exit(&gptwocfg_ops_table_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (NULL);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (ops->gptwocfg_configure == NULL) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd cmn_err(CE_WARN, "gptwocfg: no configure routine registered "
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "for sfaari type %x\n", pcd->spcd_ptype);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_exit(&gptwocfg_ops_table_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (NULL);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd new_nodes = ops->gptwocfg_configure(ap, pcd, id);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_exit(&gptwocfg_ops_table_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (new_nodes != NULL) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config = kmem_zalloc(sizeof (gptwocfg_config_t), KM_SLEEP);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config->gptwo_version = GP2_VERSION;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config->gptwo_ap = ap;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config->gptwo_portid = id;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config->gptwo_nodes = new_nodes;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config->gptwo_ops = ops;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd /*
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * put config on config list
1c42de6d020629af774dd9e9fc81be3f3ed9398egd */
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_enter(&gptwo_config_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config->gptwo_next = gptwo_config_list;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwo_config_list = config;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_exit(&gptwo_config_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd } else {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config = NULL;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return ((gptwocfg_cookie_t)config);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd}
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwocfg_cookie_t
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwocfg_unconfigure(dev_info_t *ap, gptwo_aid_t id)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd{
1c42de6d020629af774dd9e9fc81be3f3ed9398egd int i, circ;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd int failure = 0;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd dev_info_t *saf_dip;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_config_t *config, *temp;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwo_new_nodes_t *obp_nodes;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_ops_t *ops;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG2(1, CE_CONT, "gptwocfg_unconfigure: ap=0x%p id=0x%lx\n",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ap, id);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_enter(&gptwo_config_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config = gptwo_config_list;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd while (config != NULL) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (config->gptwo_portid == id) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd break;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config = config->gptwo_next;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_exit(&gptwo_config_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (config == NULL) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd /*
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * There is no config structure associated with this agent id
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * so it was probably built by firmware at start of day. We
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * need to create a config structure before we can continue.
1c42de6d020629af774dd9e9fc81be3f3ed9398egd */
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_CONT, "gptwocfg_unconfigure: id=0x%lx "
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "No config structure - Need to build one\n", id);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd obp_nodes = gptwocfg_get_obp_created_nodes(ap, id);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (obp_nodes != NULL) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config = kmem_zalloc(sizeof (gptwocfg_config_t),
1c42de6d020629af774dd9e9fc81be3f3ed9398egd KM_SLEEP);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config->gptwo_version = GP2_VERSION;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config->gptwo_ap = ap;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config->gptwo_portid = id;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config->gptwo_nodes = obp_nodes;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd /*
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * put config on config list
1c42de6d020629af774dd9e9fc81be3f3ed9398egd */
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_enter(&gptwo_config_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config->gptwo_next = gptwo_config_list;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwo_config_list = config;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_exit(&gptwo_config_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd } else {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd cmn_err(CE_WARN, "gptwocfg: gptwocfg_unconfigure: "
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "No OBP created nodes for ap=0x%lx agent id=0x%x",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd (long)ap, id);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (NULL);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_CONT, "gptwocfg_unconfigure config=0x%lx\n",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ops = config->gptwo_ops;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_CONT, "gptwocfg_unconfigure: ops=%lx\n", ops);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ndi_devi_enter(ap, &circ);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd for (i = 0; i < config->gptwo_nodes->gptwo_number_of_nodes; i++) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd dev_info_t *fdip = NULL;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd saf_dip = config->gptwo_nodes->gptwo_nodes[i];
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_CONT, "gptwocfg_unconfigure saf_dip=0x%lx\n",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd saf_dip);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (saf_dip == NULL) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG0(1, CE_CONT, "gptwocfg_unconfigure: "
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "skipping NULLL saf device\n");
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd continue;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config->gptwo_nodes->gptwo_nodes[i] = NULL;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (ops) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_CONT, "gptwocfg_configure "
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "ops->gptwocfg_configure=%lx\n",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ops->gptwocfg_configure);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_CONT, "gptwocfg_unconfigure "
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "ops->gptwocfg_unconfigure=%lx\n",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ops->gptwocfg_unconfigure);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (ops->gptwocfg_unconfigure != NULL) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config->gptwo_nodes->gptwo_nodes[i] =
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ops->gptwocfg_unconfigure(saf_dip);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_CONT, "e_ddi_branch_destroy <%s>\n",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ddi_get_name(saf_dip));
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ASSERT(e_ddi_branch_held(saf_dip));
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd /*
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * Don't hold parent busy when calling
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * e_ddi_branch_unconfigure/destroy/referenced()
1c42de6d020629af774dd9e9fc81be3f3ed9398egd */
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ndi_devi_exit(ap, circ);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (e_ddi_branch_destroy(saf_dip, &fdip, 0)) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd char *path = kmem_alloc(MAXPATHLEN, KM_SLEEP);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd /*
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * If non-NULL, fdip is held and must be released.
1c42de6d020629af774dd9e9fc81be3f3ed9398egd */
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (fdip != NULL) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd (void) ddi_pathname(fdip, path);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ddi_release_devi(fdip);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd } else {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd (void) ddi_pathname(saf_dip, path);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd cmn_err(CE_WARN, "saf node removal failed: %s (%p)",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd path, fdip ? (void *)fdip : (void *)saf_dip);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd kmem_free(path, MAXPATHLEN);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config->gptwo_nodes->gptwo_nodes[i] = saf_dip;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd failure = 1;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ndi_devi_enter(ap, &circ);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ndi_devi_exit(ap, circ);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (!failure) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_free_node_list(config->gptwo_nodes);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_enter(&gptwo_config_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (gptwo_config_list == config) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwo_config_list = config->gptwo_next;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd } else {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd temp = gptwo_config_list;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd while (temp->gptwo_next != config) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd temp = temp->gptwo_next;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd temp->gptwo_next = config->gptwo_next;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_exit(&gptwo_config_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd kmem_free(config, sizeof (gptwocfg_config_t));
1c42de6d020629af774dd9e9fc81be3f3ed9398egd config = NULL;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (config);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd}
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdint
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwocfg_next_node(gptwocfg_cookie_t c, dev_info_t *previous, dev_info_t **next)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd{
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_config_t *cookie;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd int i, j;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG3(1, CE_WARN, "gptwocfg_next_node"
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "(c=0x%lx, previous=0x%lx, next=0x%lx)\n", c, previous, next);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd cookie = (gptwocfg_config_t *)c;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd for (i = 0; i < cookie->gptwo_nodes->gptwo_number_of_nodes; i++) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_WARN, "0x%lx\n",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd cookie->gptwo_nodes->gptwo_nodes[i]);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (previous == NULL) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd for (i = 0; i < cookie->gptwo_nodes->gptwo_number_of_nodes;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd i++) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (cookie->gptwo_nodes->gptwo_nodes[i]) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd *next = cookie->gptwo_nodes->gptwo_nodes[i];
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_WARN, "returned 0x%lx\n",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd *next);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (1);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (0);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd for (i = 0; i < cookie->gptwo_nodes->gptwo_number_of_nodes; i++) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (cookie->gptwo_nodes->gptwo_nodes[i] == previous) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd for (j = i + 1;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd j < cookie->gptwo_nodes->gptwo_number_of_nodes;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd j++) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (cookie->gptwo_nodes->gptwo_nodes[j]) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd *next =
1c42de6d020629af774dd9e9fc81be3f3ed9398egd cookie->gptwo_nodes->gptwo_nodes[j];
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_WARN,
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "returned 0x%lx\n", *next);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (1);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd *next = NULL;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_WARN, "returned 0x%lx\n",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd *next);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (1);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd /*
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * previous is probably an invalid dev_info.
1c42de6d020629af774dd9e9fc81be3f3ed9398egd */
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (0);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd}
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdstatic gptwo_new_nodes_t *
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwocfg_get_obp_created_nodes(dev_info_t *ap, uint_t id)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd{
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwo_new_nodes_t *obp_nodes;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd dev_info_t *saf_dev;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd int i = 0, nodes = 0;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd int circular_count;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG2(1, CE_CONT, "gptwocfg_get_obp_created_nodes - ap=0x%lx "
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "id=0x%x\n", ap, id);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ndi_devi_enter(ap, &circular_count);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd /*
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * First go through all the children of the attachment point
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * to count matching safari agent ids
1c42de6d020629af774dd9e9fc81be3f3ed9398egd */
1c42de6d020629af774dd9e9fc81be3f3ed9398egd saf_dev = ddi_get_child(ap);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd while (saf_dev != NULL) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (ddi_getprop(DDI_DEV_T_ANY, saf_dev, DDI_PROP_DONTPASS,
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "portid", -1) == id) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (&starcat_dr_name) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (starcat_dr_name(ddi_node_name(saf_dev))
1c42de6d020629af774dd9e9fc81be3f3ed9398egd < 0) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd saf_dev = ddi_get_next_sibling(saf_dev);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd continue;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd nodes++;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd saf_dev = ddi_get_next_sibling(saf_dev);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_CONT, "gptwocfg_get_obp_created_nodes - %d nodes "
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "found\n", nodes);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd obp_nodes = gptwocfg_allocate_node_list(nodes);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd /*
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * Then fill in the nodes structure.
1c42de6d020629af774dd9e9fc81be3f3ed9398egd */
1c42de6d020629af774dd9e9fc81be3f3ed9398egd saf_dev = ddi_get_child(ap);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd while ((saf_dev != NULL) && (i < nodes)) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (ddi_getprop(DDI_DEV_T_ANY, saf_dev, DDI_PROP_DONTPASS,
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "portid", -1) == id) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (&starcat_dr_name) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (starcat_dr_name(ddi_node_name(saf_dev))
1c42de6d020629af774dd9e9fc81be3f3ed9398egd < 0) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd saf_dev = ddi_get_next_sibling(saf_dev);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd continue;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd /*
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * Branch rooted at this dip must have been
1c42de6d020629af774dd9e9fc81be3f3ed9398egd * held by the DR driver.
1c42de6d020629af774dd9e9fc81be3f3ed9398egd */
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ASSERT(e_ddi_branch_held(saf_dev));
1c42de6d020629af774dd9e9fc81be3f3ed9398egd obp_nodes->gptwo_nodes[i++] = saf_dev;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd saf_dev = ddi_get_next_sibling(saf_dev);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd ndi_devi_exit(ap, circular_count);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_CONT, "gptwocfg_get_obp_created_nodes - "
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "Returning 0x%lx\n", obp_nodes);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (obp_nodes);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd}
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdvoid
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwocfg_save_handle(dev_info_t *dip, fco_handle_t fco_handle)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd{
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_handle_list_t *h;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG2(1, CE_CONT, "gptwocfg_save_handle - "
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "dip=%lx fco_handle=%lx\n", dip, fco_handle);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd h = kmem_zalloc(sizeof (gptwocfg_handle_list_t), KM_SLEEP);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_enter(&gptwo_handle_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd h->next = gptwocfg_handle_list;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd h->dip = dip;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd h->fco_handle = fco_handle;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_handle_list = h;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_exit(&gptwo_handle_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd}
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdfco_handle_t
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwocfg_get_handle(dev_info_t *dip)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd{
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_handle_list_t *h, *last;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd fco_handle_t fco_handle;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_enter(&gptwo_handle_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd h = last = gptwocfg_handle_list;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd while (h != NULL) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (h->dip == dip) {
1c42de6d020629af774dd9e9fc81be3f3ed9398egd if (h == gptwocfg_handle_list)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd gptwocfg_handle_list = h->next;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd else
1c42de6d020629af774dd9e9fc81be3f3ed9398egd last->next = h->next;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_exit(&gptwo_handle_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd fco_handle = h->fco_handle;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd kmem_free(h, sizeof (gptwocfg_handle_list_t));
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG2(1, CE_CONT, "gptwocfg_get_handle - "
1c42de6d020629af774dd9e9fc81be3f3ed9398egd "dip=%lx fco_handle=%lx\n", dip, fco_handle);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (fco_handle);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd last = h;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd h = h->next;
1c42de6d020629af774dd9e9fc81be3f3ed9398egd }
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd mutex_exit(&gptwo_handle_list_lock);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd GPTWO_DEBUG1(1, CE_CONT, "gptwocfg_get_handle - dip=%lx NO HANDLE\n",
1c42de6d020629af774dd9e9fc81be3f3ed9398egd dip);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd return (0);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd}
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egdvoid
1c42de6d020629af774dd9e9fc81be3f3ed9398egdgptwocfg_devi_attach_to_parent(dev_info_t *dip)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd{
1c42de6d020629af774dd9e9fc81be3f3ed9398egd (void) i_ndi_config_node(dip, DS_LINKED, 0);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd}
1c42de6d020629af774dd9e9fc81be3f3ed9398egd
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#ifdef DEBUG
1c42de6d020629af774dd9e9fc81be3f3ed9398egdstatic void
1c42de6d020629af774dd9e9fc81be3f3ed9398egddebug(char *fmt, uintptr_t a1, uintptr_t a2, uintptr_t a3,
1c42de6d020629af774dd9e9fc81be3f3ed9398egd uintptr_t a4, uintptr_t a5)
1c42de6d020629af774dd9e9fc81be3f3ed9398egd{
1c42de6d020629af774dd9e9fc81be3f3ed9398egd cmn_err(CE_CONT, fmt, a1, a2, a3, a4, a5);
1c42de6d020629af774dd9e9fc81be3f3ed9398egd}
1c42de6d020629af774dd9e9fc81be3f3ed9398egd#endif