1 /* 2 * CDDL HEADER START 3 * 4 * The contents of this file are subject to the terms of the 5 * Common Development and Distribution License (the "License"). 6 * You may not use this file except in compliance with the License. 7 * 8 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE 9 * or http://www.opensolaris.org/os/licensing. 10 * See the License for the specific language governing permissions 11 * and limitations under the License. 12 * 13 * When distributing Covered Code, include this CDDL HEADER in each 14 * file and include the License file at usr/src/OPENSOLARIS.LICENSE. 15 * If applicable, add the following below this CDDL HEADER, with the 16 * fields enclosed by brackets "[]" replaced with your own identifying 17 * information: Portions Copyright [yyyy] [name of copyright owner] 18 * 19 * CDDL HEADER END 20 */ 21 22 /* 23 * Copyright 2008 Sun Microsystems, Inc. All rights reserved. 24 * Use is subject to license terms. 25 */ 26 27 #pragma ident "%Z%%M% %I% %E% SMI" 28 29 #include <sys/modctl.h> 30 #include <sys/prom_plat.h> 31 #include <sys/ddi.h> 32 #include <sys/sunddi.h> 33 #include <sys/sunndi.h> 34 #include <sys/ndi_impldefs.h> 35 #include <sys/ddi_impldefs.h> 36 #include <sys/ethernet.h> 37 #include <sys/machsystm.h> 38 #include <sys/hypervisor_api.h> 39 #include <sys/mach_descrip.h> 40 #include <sys/drctl.h> 41 #include <sys/dr_util.h> 42 #include <sys/mac.h> 43 #include <sys/vnet.h> 44 #include <sys/vnet_mailbox.h> 45 #include <sys/vnet_common.h> 46 #include <sys/hsvc.h> 47 48 49 #define VDDS_MAX_RANGES 6 /* 6 possible VRs */ 50 #define VDDS_MAX_VRINTRS 8 /* limited to 8 intrs/VR */ 51 #define VDDS_MAX_INTR_NUM 64 /* 0-63 or valid */ 52 53 #define VDDS_INO_RANGE_START(x) (x * VDDS_MAX_VRINTRS) 54 #define HVCOOKIE(c) ((c) & 0xFFFFFFFFF) 55 #define NIUCFGHDL(c) ((c) >> 32) 56 57 58 /* For "ranges" property */ 59 typedef struct vdds_ranges { 60 uint32_t child_hi; 61 uint32_t child_lo; 62 uint32_t parent_hi; 63 uint32_t parent_lo; 64 uint32_t size_hi; 65 uint32_t size_lo; 66 } vdds_ranges_t; 67 68 /* For "reg" property */ 69 typedef struct vdds_reg { 70 uint32_t addr_hi; 71 uint32_t addr_lo; 72 uint32_t size_hi; 73 uint32_t size_lo; 74 } vdds_reg_t; 75 76 /* For ddi callback argument */ 77 typedef struct vdds_cb_arg { 78 dev_info_t *dip; 79 uint64_t cookie; 80 uint64_t macaddr; 81 } vdds_cb_arg_t; 82 83 84 /* Functions exported to other files */ 85 void vdds_mod_init(void); 86 void vdds_mod_fini(void); 87 int vdds_init(vnet_t *vnetp); 88 void vdds_cleanup(vnet_t *vnetp); 89 void vdds_process_dds_msg(vnet_t *vnetp, vio_dds_msg_t *dmsg); 90 void vdds_cleanup_hybrid_res(vnet_t *vnetp); 91 92 /* Support functions to create/destory Hybrid device */ 93 static dev_info_t *vdds_create_niu_node(uint64_t cookie, uint64_t macaddr); 94 static int vdds_destroy_niu_node(dev_info_t *niu_dip, uint64_t cookie); 95 static dev_info_t *vdds_create_new_node(uint64_t cookie, uint64_t macddr, 96 dev_info_t *pdip, int (*new_node_func)(dev_info_t *dip, 97 void *arg, uint_t flags)); 98 static int vdds_new_nexus_node(dev_info_t *dip, void *arg, uint_t flags); 99 static int vdds_new_niu_node(dev_info_t *dip, void *arg, uint_t flags); 100 static dev_info_t *vdds_find_node(uint64_t cookie, dev_info_t *sdip, 101 int (*match_func)(dev_info_t *dip, void *arg)); 102 static int vdds_match_niu_nexus(dev_info_t *dip, void *arg); 103 static int vdds_match_niu_node(dev_info_t *dip, void *arg); 104 static int vdds_get_interrupts(uint64_t cookie, int ino_range, 105 int *intrs, int *nintr); 106 107 /* DDS message processing related functions */ 108 static void vdds_process_dds_msg_task(void *arg); 109 static int vdds_send_dds_resp_msg(vnet_t *vnetp, vio_dds_msg_t *dmsg, int ack); 110 static int vdds_send_dds_rel_msg(vnet_t *vnetp); 111 static void vdds_release_range_prop(dev_info_t *nexus_dip, uint64_t cookie); 112 113 /* Functions imported from other files */ 114 extern int vnet_send_dds_msg(vnet_t *vnetp, void *dmsg); 115 116 /* HV functions that are used in this file */ 117 extern uint64_t vdds_hv_niu_vr_getinfo(uint32_t hvcookie, 118 uint64_t *real_start, uint64_t *size); 119 extern uint64_t vdds_hv_niu_vr_get_txmap(uint32_t hvcookie, uint64_t *dma_map); 120 extern uint64_t vdds_hv_niu_vr_get_rxmap(uint32_t hvcookie, uint64_t *dma_map); 121 extern uint64_t vdds_hv_niu_vrtx_set_ino(uint32_t cookie, uint64_t vch_idx, 122 uint32_t ino); 123 extern uint64_t vdds_hv_niu_vrrx_set_ino(uint32_t cookie, uint64_t vch_idx, 124 uint32_t ino); 125 126 127 #ifdef DEBUG 128 129 extern int vnet_dbglevel; 130 131 static void 132 debug_printf(const char *fname, void *arg, const char *fmt, ...) 133 { 134 char buf[512]; 135 va_list ap; 136 char *bufp = buf; 137 vnet_dds_info_t *vdds = arg; 138 139 if (vdds != NULL) { 140 (void) sprintf(bufp, "vnet%d: %s: ", 141 vdds->vnetp->instance, fname); 142 } else { 143 (void) sprintf(bufp, "%s: ", fname); 144 } 145 bufp += strlen(bufp); 146 va_start(ap, fmt); 147 (void) vsprintf(bufp, fmt, ap); 148 va_end(ap); 149 cmn_err(CE_CONT, "%s\n", buf); 150 } 151 #endif 152 153 /* 154 * Hypervisor N2/NIU services information. 155 */ 156 static hsvc_info_t niu_hsvc = { 157 HSVC_REV_1, NULL, HSVC_GROUP_NIU, 1, 1, "vnet_dds" 158 }; 159 160 boolean_t vdds_hv_hio_capable = B_FALSE; 161 162 /* 163 * vdds_mod_init -- one time initialization. 164 */ 165 void 166 vdds_mod_init(void) 167 { 168 int rv; 169 uint64_t minor; 170 171 rv = hsvc_register(&niu_hsvc, &minor); 172 /* 173 * Only HV version 1.1 is capable of NIU Hybrid IO. 174 */ 175 if ((rv == 0) && (minor == 1)) { 176 vdds_hv_hio_capable = B_TRUE; 177 } 178 DBG1(NULL, "HV HIO capable"); 179 } 180 181 /* 182 * vdds_mod_fini -- one time cleanup. 183 */ 184 void 185 vdds_mod_fini(void) 186 { 187 (void) hsvc_unregister(&niu_hsvc); 188 } 189 190 /* 191 * vdds_init -- vnet instance related DDS related initialization. 192 */ 193 int 194 vdds_init(vnet_t *vnetp) 195 { 196 vnet_dds_info_t *vdds = &vnetp->vdds_info; 197 char qname[TASKQ_NAMELEN]; 198 199 vdds->vnetp = vnetp; 200 DBG1(vdds, "Initializing.."); 201 (void) snprintf(qname, TASKQ_NAMELEN, "vdds_taskq%d", vnetp->instance); 202 if ((vdds->dds_taskqp = ddi_taskq_create(vnetp->dip, qname, 1, 203 TASKQ_DEFAULTPRI, 0)) == NULL) { 204 cmn_err(CE_WARN, "!vnet%d: Unable to create DDS task queue", 205 vnetp->instance); 206 return (ENOMEM); 207 } 208 mutex_init(&vdds->lock, NULL, MUTEX_DRIVER, NULL); 209 return (0); 210 } 211 212 /* 213 * vdds_cleanup -- vnet instance related cleanup. 214 */ 215 void 216 vdds_cleanup(vnet_t *vnetp) 217 { 218 vnet_dds_info_t *vdds = &vnetp->vdds_info; 219 220 DBG1(vdds, "Cleanup..."); 221 /* Cleanup/destroy any hybrid resouce that exists */ 222 vdds_cleanup_hybrid_res(vnetp); 223 224 /* taskq_destroy will wait for all taskqs to complete */ 225 ddi_taskq_destroy(vdds->dds_taskqp); 226 vdds->dds_taskqp = NULL; 227 mutex_destroy(&vdds->lock); 228 DBG1(vdds, "Cleanup complete"); 229 } 230 231 /* 232 * vdds_cleanup_hybrid_res -- Cleanup Hybrid resource. 233 */ 234 void 235 vdds_cleanup_hybrid_res(vnet_t *vnetp) 236 { 237 vnet_dds_info_t *vdds = &vnetp->vdds_info; 238 239 DBG1(vdds, "Hybrid device cleanup..."); 240 mutex_enter(&vdds->lock); 241 if (vdds->task_flags == VNET_DDS_TASK_ADD_SHARE) { 242 /* 243 * Task for ADD_SHARE is pending, simply 244 * cleanup the flags, the task will quit without 245 * any changes. 246 */ 247 vdds->task_flags = 0; 248 DBG2(vdds, "Task for ADD is pending, clean flags only"); 249 } else if ((vdds->hio_dip != NULL) && (vdds->task_flags == 0)) { 250 /* 251 * There is no task pending and a hybrid device 252 * is present, so dispatch a task to release the share. 253 */ 254 vdds->task_flags = VNET_DDS_TASK_REL_SHARE; 255 (void) ddi_taskq_dispatch(vdds->dds_taskqp, 256 vdds_process_dds_msg_task, vnetp, DDI_NOSLEEP); 257 DBG2(vdds, "Dispatched a task to destroy HIO device"); 258 } 259 /* 260 * Other possible cases include either DEL_SHARE or 261 * REL_SHARE as pending. In that case, there is nothing 262 * to do as a task is already pending to do the cleanup. 263 */ 264 mutex_exit(&vdds->lock); 265 DBG1(vdds, "Hybrid device cleanup complete"); 266 } 267 268 /* 269 * vdds_process_dds_msg -- Process a DDS message. 270 */ 271 void 272 vdds_process_dds_msg(vnet_t *vnetp, vio_dds_msg_t *dmsg) 273 { 274 vnet_dds_info_t *vdds = &vnetp->vdds_info; 275 int rv; 276 277 DBG1(vdds, "DDS message received..."); 278 279 if (dmsg->dds_class != DDS_VNET_NIU) { 280 DBG2(vdds, "Invalid class send NACK"); 281 (void) vdds_send_dds_resp_msg(vnetp, dmsg, B_FALSE); 282 return; 283 } 284 mutex_enter(&vdds->lock); 285 switch (dmsg->dds_subclass) { 286 case DDS_VNET_ADD_SHARE: 287 DBG2(vdds, "DDS_VNET_ADD_SHARE message..."); 288 if ((vdds->task_flags != 0) || (vdds->hio_dip != NULL)) { 289 /* 290 * Either a task is already pending or 291 * a hybrid device already exists. 292 */ 293 DWARN(vdds, "NACK: Already pending DDS task"); 294 (void) vdds_send_dds_resp_msg(vnetp, dmsg, B_FALSE); 295 mutex_exit(&vdds->lock); 296 return; 297 } 298 vdds->task_flags = VNET_DDS_TASK_ADD_SHARE; 299 bcopy(dmsg, &vnetp->vdds_info.dmsg, sizeof (vio_dds_msg_t)); 300 DBG2(vdds, "Dispatching task for ADD_SHARE"); 301 rv = ddi_taskq_dispatch(vdds->dds_taskqp, 302 vdds_process_dds_msg_task, vnetp, DDI_NOSLEEP); 303 if (rv != 0) { 304 /* Send NACK */ 305 DBG2(vdds, "NACK: Failed to dispatch task"); 306 (void) vdds_send_dds_resp_msg(vnetp, dmsg, B_FALSE); 307 vdds->task_flags = 0; 308 } 309 break; 310 311 case DDS_VNET_DEL_SHARE: 312 DBG2(vdds, "DDS_VNET_DEL_SHARE message..."); 313 if (vdds->task_flags == VNET_DDS_TASK_ADD_SHARE) { 314 /* 315 * ADD_SHARE task still pending, simply clear 316 * task falgs and ACK. 317 */ 318 DBG2(vdds, "ACK:ADD_SHARE task still pending"); 319 vdds->task_flags = 0; 320 (void) vdds_send_dds_resp_msg(vnetp, dmsg, B_TRUE); 321 mutex_exit(&vdds->lock); 322 return; 323 } 324 if ((vdds->task_flags == 0) && (vdds->hio_dip == NULL)) { 325 /* Send NACK */ 326 DBG2(vdds, "NACK:No HIO device exists"); 327 (void) vdds_send_dds_resp_msg(vnetp, dmsg, B_FALSE); 328 mutex_exit(&vdds->lock); 329 return; 330 } 331 vdds->task_flags = VNET_DDS_TASK_DEL_SHARE; 332 bcopy(dmsg, &vdds->dmsg, sizeof (vio_dds_msg_t)); 333 DBG2(vdds, "Dispatching DEL_SHARE task"); 334 rv = ddi_taskq_dispatch(vdds->dds_taskqp, 335 vdds_process_dds_msg_task, vnetp, DDI_NOSLEEP); 336 if (rv != 0) { 337 /* Send NACK */ 338 DBG2(vdds, "NACK: failed to dispatch task"); 339 (void) vdds_send_dds_resp_msg(vnetp, dmsg, B_FALSE); 340 vdds->task_flags = 0; 341 } 342 break; 343 case DDS_VNET_REL_SHARE: 344 DBG2(vdds, "Reply for REL_SHARE reply=%d", 345 dmsg->tag.vio_subtype); 346 break; 347 default: 348 DWARN(vdds, "Discarding Unknown DDS message"); 349 break; 350 } 351 mutex_exit(&vdds->lock); 352 } 353 354 /* 355 * vdds_process_dds_msg_task -- Called from a taskq to process the 356 * DDS message. 357 */ 358 static void 359 vdds_process_dds_msg_task(void *arg) 360 { 361 vnet_t *vnetp = arg; 362 vnet_dds_info_t *vdds = &vnetp->vdds_info; 363 vio_dds_msg_t *dmsg = &vdds->dmsg; 364 dev_info_t *dip; 365 uint64_t hio_cookie; 366 int rv; 367 368 DBG1(vdds, "DDS task started..."); 369 mutex_enter(&vdds->lock); 370 switch (vdds->task_flags) { 371 case VNET_DDS_TASK_ADD_SHARE: 372 DBG2(vdds, "ADD_SHARE task..."); 373 hio_cookie = dmsg->msg.share_msg.cookie; 374 dip = vdds_create_niu_node(hio_cookie, 375 dmsg->msg.share_msg.macaddr); 376 if (dip == NULL) { 377 (void) vdds_send_dds_resp_msg(vnetp, dmsg, B_FALSE); 378 DERR(vdds, "Failed to create HIO node"); 379 } else { 380 vdds->hio_dip = dip; 381 vdds->hio_cookie = hio_cookie; 382 (void) vdds_send_dds_resp_msg(vnetp, dmsg, B_TRUE); 383 /* DERR used only print by default */ 384 DERR(vdds, "Successfully created HIO node"); 385 } 386 break; 387 388 case VNET_DDS_TASK_DEL_SHARE: 389 DBG2(vdds, "DEL_SHARE task..."); 390 if (vnetp->vdds_info.hio_dip == NULL) { 391 DBG2(vdds, "NACK: No HIO device destroy"); 392 (void) vdds_send_dds_resp_msg(vnetp, dmsg, B_FALSE); 393 } else { 394 rv = vdds_destroy_niu_node(vnetp->vdds_info.hio_dip, 395 vdds->hio_cookie); 396 if (rv == 0) { 397 /* use DERR to print by default */ 398 DERR(vdds, "Successfully destroyed" 399 " Hybrid node"); 400 } else { 401 cmn_err(CE_WARN, "vnet%d:Failed to " 402 "destroy Hybrid node", vnetp->instance); 403 } 404 /* TODO: send ACK even for failure? */ 405 DBG2(vdds, "ACK: HIO device destroyed"); 406 (void) vdds_send_dds_resp_msg(vnetp, dmsg, B_TRUE); 407 vdds->hio_dip = 0; 408 vdds->hio_cookie = 0; 409 } 410 break; 411 case VNET_DDS_TASK_REL_SHARE: 412 DBG2(vdds, "REL_SHARE task..."); 413 if (vnetp->vdds_info.hio_dip != NULL) { 414 rv = vdds_destroy_niu_node(vnetp->vdds_info.hio_dip, 415 vdds->hio_cookie); 416 if (rv == 0) { 417 DERR(vdds, "Successfully destroyed " 418 "Hybrid node"); 419 } else { 420 cmn_err(CE_WARN, "vnet%d:Failed to " 421 "destroy HIO node", vnetp->instance); 422 } 423 /* TODO: failure case */ 424 (void) vdds_send_dds_rel_msg(vnetp); 425 vdds->hio_dip = 0; 426 vdds->hio_cookie = 0; 427 } 428 break; 429 default: 430 break; 431 } 432 vdds->task_flags = 0; 433 mutex_exit(&vdds->lock); 434 } 435 436 /* 437 * vdds_send_dds_rel_msg -- Send a DDS_REL_SHARE message. 438 */ 439 static int 440 vdds_send_dds_rel_msg(vnet_t *vnetp) 441 { 442 vnet_dds_info_t *vdds = &vnetp->vdds_info; 443 vio_dds_msg_t vmsg; 444 dds_share_msg_t *smsg = &vmsg.msg.share_msg; 445 int rv; 446 447 DBG1(vdds, "Sending DDS_VNET_REL_SHARE message"); 448 vmsg.tag.vio_msgtype = VIO_TYPE_CTRL; 449 vmsg.tag.vio_subtype = VIO_SUBTYPE_INFO; 450 vmsg.tag.vio_subtype_env = VIO_DDS_INFO; 451 /* vio_sid filled by the LDC module */ 452 vmsg.dds_class = DDS_VNET_NIU; 453 vmsg.dds_subclass = DDS_VNET_REL_SHARE; 454 vmsg.dds_req_id = (++vdds->dds_req_id); 455 smsg->macaddr = vnet_macaddr_strtoul(vnetp->curr_macaddr); 456 smsg->cookie = vdds->hio_cookie; 457 rv = vnet_send_dds_msg(vnetp, &vmsg); 458 return (rv); 459 } 460 461 /* 462 * vdds_send_dds_resp_msg -- Send a DDS response message. 463 */ 464 static int 465 vdds_send_dds_resp_msg(vnet_t *vnetp, vio_dds_msg_t *dmsg, int ack) 466 { 467 vnet_dds_info_t *vdds = &vnetp->vdds_info; 468 int rv; 469 470 DBG1(vdds, "Sending a response mesage=%d", ack); 471 if (ack == B_TRUE) { 472 dmsg->tag.vio_subtype = VIO_SUBTYPE_ACK; 473 dmsg->msg.share_resp_msg.status = DDS_VNET_SUCCESS; 474 } else { 475 dmsg->tag.vio_subtype = VIO_SUBTYPE_NACK; 476 dmsg->msg.share_resp_msg.status = DDS_VNET_FAIL; 477 } 478 rv = vnet_send_dds_msg(vnetp, dmsg); 479 return (rv); 480 } 481 482 /* 483 * vdds_create_niu_node -- Create NIU Hybrid node. The NIU nexus 484 * node also created if it doesn't exist already. 485 */ 486 dev_info_t * 487 vdds_create_niu_node(uint64_t cookie, uint64_t macaddr) 488 { 489 dev_info_t *nexus_dip; 490 dev_info_t *niu_dip; 491 492 DBG1(NULL, "Called"); 493 494 if (vdds_hv_hio_capable == B_FALSE) { 495 return (NULL); 496 } 497 /* Check if the nexus node exists already */ 498 nexus_dip = vdds_find_node(cookie, ddi_root_node(), 499 vdds_match_niu_nexus); 500 if (nexus_dip == NULL) { 501 /* 502 * NIU nexus node not found, so create it now. 503 */ 504 nexus_dip = vdds_create_new_node(cookie, macaddr, NULL, 505 vdds_new_nexus_node); 506 if (nexus_dip == NULL) { 507 return (NULL); 508 } 509 } 510 DBG2(NULL, "nexus_dip = 0x%p", nexus_dip); 511 512 /* Check if NIU node exists already before creating one */ 513 niu_dip = vdds_find_node(cookie, nexus_dip, 514 vdds_match_niu_node); 515 if (niu_dip == NULL) { 516 niu_dip = vdds_create_new_node(cookie, macaddr, nexus_dip, 517 vdds_new_niu_node); 518 if (niu_dip == NULL) { 519 DWARN(NULL, "create_niu_hio_node returned NULL"); 520 } 521 /* 522 * Do not release the niu_dip to prevent it from 523 * auto-detach/unload. 524 */ 525 ndi_rele_devi(nexus_dip); 526 return (niu_dip); 527 528 } 529 DWARN(NULL, "niumx/network node already exists(dip=0x%p)", niu_dip); 530 ndi_rele_devi(niu_dip); 531 ndi_rele_devi(nexus_dip); 532 DBG1(NULL, "returning success"); 533 return (niu_dip); 534 } 535 536 /* 537 * vdds_destroy_niu_node -- Destroy the NIU node. 538 */ 539 int 540 vdds_destroy_niu_node(dev_info_t *niu_dip, uint64_t cookie) 541 { 542 int rv; 543 dev_info_t *fdip = NULL; 544 dev_info_t *nexus_dip = ddi_get_parent(niu_dip); 545 546 547 DBG1(NULL, "Called"); 548 ndi_rele_devi(niu_dip); 549 rv = e_ddi_branch_unconfigure(niu_dip, &fdip, 0); 550 if (rv != 0) { 551 DERR(NULL, "Failed to unconfigure niumx/network node dip=0x%p", 552 niu_dip); 553 if (fdip != NULL) { 554 ndi_rele_devi(fdip); 555 } 556 return (EBUSY); 557 } 558 rv = e_ddi_branch_destroy(niu_dip, &fdip, 0); 559 if (rv != 0) { 560 DERR(NULL, "Failed to destroy niumx/network node dip=0x%p", 561 niu_dip); 562 if (fdip != NULL) { 563 ndi_rele_devi(fdip); 564 } 565 return (EBUSY); 566 } 567 /* 568 * Cleanup the parent's ranges property set 569 * for this Hybrid device. 570 */ 571 vdds_release_range_prop(nexus_dip, cookie); 572 DBG1(NULL, "returning success"); 573 return (0); 574 } 575 576 /* 577 * vdds_match_niu_nexus -- callback function to verify a node is the 578 * NIU nexus node. 579 */ 580 static int 581 vdds_match_niu_nexus(dev_info_t *dip, void *arg) 582 { 583 vdds_cb_arg_t *warg = (vdds_cb_arg_t *)arg; 584 vdds_reg_t *reg_p; 585 char *name; 586 uint64_t hdl; 587 uint_t reglen; 588 int rv; 589 590 if (dip == ddi_root_node()) { 591 return (DDI_WALK_CONTINUE); 592 } 593 594 name = ddi_node_name(dip); 595 if (strcmp(name, "niu") != 0) { 596 return (DDI_WALK_CONTINUE); 597 } 598 rv = ddi_prop_lookup_int_array(DDI_DEV_T_ANY, dip, 599 DDI_PROP_DONTPASS, "reg", (int **)®_p, ®len); 600 if (rv != DDI_PROP_SUCCESS) { 601 DWARN(NULL, "Failed to get reg property dip=0x%p", dip); 602 return (DDI_WALK_CONTINUE); 603 } 604 605 hdl = reg_p->addr_hi & 0x0FFFFFFF; 606 ddi_prop_free(reg_p); 607 608 DBG2(NULL, "Handle = 0x%lx dip=0x%p", hdl, dip); 609 if (hdl == NIUCFGHDL(warg->cookie)) { 610 /* Hold before returning */ 611 ndi_hold_devi(dip); 612 warg->dip = dip; 613 DBG2(NULL, "Found dip = 0x%p", dip); 614 return (DDI_WALK_TERMINATE); 615 } 616 return (DDI_WALK_CONTINUE); 617 } 618 619 /* 620 * vdds_match_niu_node -- callback function to verify a node is the 621 * NIU Hybrid node. 622 */ 623 static int 624 vdds_match_niu_node(dev_info_t *dip, void *arg) 625 { 626 vdds_cb_arg_t *warg = (vdds_cb_arg_t *)arg; 627 char *name; 628 vdds_reg_t *reg_p; 629 uint_t reglen; 630 int rv; 631 uint32_t addr_hi; 632 633 name = ddi_node_name(dip); 634 if (strcmp(name, "network") != 0) { 635 return (DDI_WALK_CONTINUE); 636 } 637 rv = ddi_prop_lookup_int_array(DDI_DEV_T_ANY, dip, 638 DDI_PROP_DONTPASS, "reg", (int **)®_p, ®len); 639 if (rv != DDI_PROP_SUCCESS) { 640 DWARN(NULL, "Failed to get reg property dip=0x%p", dip); 641 return (DDI_WALK_CONTINUE); 642 } 643 644 addr_hi = reg_p->addr_hi; 645 DBG1(NULL, "addr_hi = 0x%x dip=0x%p", addr_hi, dip); 646 ddi_prop_free(reg_p); 647 if (addr_hi == HVCOOKIE(warg->cookie)) { 648 ndi_hold_devi(dip); 649 warg->dip = dip; 650 DBG1(NULL, "Found dip = 0x%p", dip); 651 return (DDI_WALK_TERMINATE); 652 } 653 return (DDI_WALK_CONTINUE); 654 } 655 656 /* 657 * vdds_new_nexus_node -- callback function to set all the properties 658 * a new NIU nexus node. 659 */ 660 static int 661 vdds_new_nexus_node(dev_info_t *dip, void *arg, uint_t flags) 662 { 663 vdds_cb_arg_t *cba = (vdds_cb_arg_t *)arg; 664 char *compat[] = { "SUNW,niumx" }; 665 vdds_ranges_t *rangesp; 666 vdds_reg_t reg; 667 uint64_t nranges; 668 int n; 669 670 DBG1(NULL, "Called dip=0x%p, flags=0x%X", dip, flags); 671 672 /* create "niu" property */ 673 if (ndi_prop_update_string(DDI_DEV_T_NONE, dip, "name", "niu") != 674 DDI_SUCCESS) { 675 DERR(NULL, "Failed to create name property(dip=0x%p)", dip); 676 return (DDI_WALK_ERROR); 677 } 678 679 /* create "compatible" property */ 680 if (ndi_prop_update_string_array(DDI_DEV_T_NONE, dip, "compatible", 681 compat, 1) != DDI_SUCCESS) { 682 DERR(NULL, "Failed to create compatible property(dip=0x%p)", 683 dip); 684 return (DDI_WALK_ERROR); 685 } 686 687 /* create "device_type" property */ 688 if (ndi_prop_update_string(DDI_DEV_T_NONE, dip, 689 "device_type", "sun4v") != DDI_SUCCESS) { 690 DERR(NULL, "Failed to create device_type property(dip=0x%p)", 691 dip); 692 return (DDI_WALK_ERROR); 693 } 694 695 /* 696 * create "reg" property. The first 28 bits of 697 * 'addr_hi' are NIU cfg_handle, the 0xc in 28-31 bits 698 * indicates non-cacheable config. 699 */ 700 reg.addr_hi = 0xc0000000 | NIUCFGHDL(cba->cookie); 701 reg.addr_lo = 0; 702 reg.size_hi = 0; 703 reg.size_lo = 0; 704 if (ndi_prop_update_int_array(DDI_DEV_T_NONE, dip, 705 "reg", (int *)®, sizeof (reg)/sizeof (int)) != DDI_SUCCESS) { 706 DERR(NULL, "Failed to create reg property(dip=0x%p)", dip); 707 return (DDI_WALK_ERROR); 708 } 709 710 /* 711 * Create VDDS_MAX_RANGES so that they are already in place 712 * before the children are created. While creating the child 713 * we just modify one of this ranges entries. 714 */ 715 nranges = VDDS_MAX_RANGES; /* One range for each VR */ 716 rangesp = (vdds_ranges_t *)kmem_zalloc( 717 (sizeof (vdds_ranges_t) * nranges), KM_SLEEP); 718 719 for (n = 0; n < nranges; n++) { 720 /* zero all child_hi/lo */ 721 rangesp[n].child_hi = 0; 722 rangesp[n].child_lo = 0; 723 } 724 725 if (ndi_prop_update_int_array(DDI_DEV_T_NONE, dip, "ranges", 726 (int *)rangesp, (nranges * 6)) != DDI_SUCCESS) { 727 DERR(NULL, "Failed to create ranges property(dip=0x%p)", dip); 728 kmem_free(rangesp, (sizeof (vdds_ranges_t) * nranges)); 729 return (DDI_WALK_ERROR); 730 } 731 732 /* create "#size-cells" property */ 733 if (ndi_prop_update_int(DDI_DEV_T_NONE, dip, 734 "#size-cells", 2) != DDI_SUCCESS) { 735 DERR(NULL, "Failed to create #size-cells property(dip=0x%p)", 736 dip); 737 kmem_free(rangesp, (sizeof (vdds_ranges_t) * nranges)); 738 return (DDI_WALK_ERROR); 739 } 740 741 /* create "#address-cells" property */ 742 if (ndi_prop_update_int(DDI_DEV_T_NONE, dip, 743 "#address-cells", 2) != DDI_SUCCESS) { 744 DERR(NULL, "Failed to create #address-cells prop(dip=0x%p)", 745 dip); 746 kmem_free(rangesp, (sizeof (vdds_ranges_t) * nranges)); 747 return (DDI_WALK_ERROR); 748 } 749 750 kmem_free(rangesp, (sizeof (vdds_ranges_t) * nranges)); 751 cba->dip = dip; 752 ndi_hold_devi(dip); 753 DBG1(NULL, "Returning (dip=0x%p)", dip); 754 return (DDI_WALK_TERMINATE); 755 } 756 757 /* 758 * vdds_new_niu_node -- callback function to create a new NIU Hybrid node. 759 */ 760 static int 761 vdds_new_niu_node(dev_info_t *dip, void *arg, uint_t flags) 762 { 763 vdds_cb_arg_t *cba = (vdds_cb_arg_t *)arg; 764 char *compat[] = { "SUNW,niusl" }; 765 uint8_t macaddrbytes[ETHERADDRL]; 766 int interrupts[VDDS_MAX_VRINTRS]; 767 vdds_ranges_t *prng; 768 vdds_ranges_t *prp; 769 vdds_reg_t reg; 770 dev_info_t *pdip; 771 uint64_t start; 772 uint64_t size; 773 int prnglen; 774 int nintr = 0; 775 int nrng; 776 int rnum; 777 int rv; 778 779 DBG1(NULL, "Called dip=0x%p flags=0x%X", dip, flags); 780 pdip = ddi_get_parent(dip); 781 782 if (pdip == NULL) { 783 DWARN(NULL, "Failed to get parent dip(dip=0x%p)", dip); 784 return (DDI_WALK_ERROR); 785 } 786 787 /* create "network" property */ 788 if (ndi_prop_update_string(DDI_DEV_T_NONE, dip, "name", "network") != 789 DDI_SUCCESS) { 790 DERR(NULL, "Failed to create name property(dip=0x%p)", dip); 791 return (DDI_WALK_ERROR); 792 } 793 794 /* 795 * create "niutype" property, it is set to n2niu to 796 * indicate NIU Hybrid node. 797 */ 798 if (ndi_prop_update_string(DDI_DEV_T_NONE, dip, "niutype", 799 "n2niu") != DDI_SUCCESS) { 800 DERR(NULL, "Failed to create niuopmode property(dip=0x%p)", 801 dip); 802 return (DDI_WALK_ERROR); 803 } 804 805 /* create "compatible" property */ 806 if (ndi_prop_update_string_array(DDI_DEV_T_NONE, dip, "compatible", 807 compat, 1) != DDI_SUCCESS) { 808 DERR(NULL, "Failed to create compatible property(dip=0x%p)", 809 dip); 810 return (DDI_WALK_ERROR); 811 } 812 813 /* create "device_type" property */ 814 if (ndi_prop_update_string(DDI_DEV_T_NONE, dip, 815 "device_type", "network") != DDI_SUCCESS) { 816 DERR(NULL, "Failed to create device_type property(dip=0x%p)", 817 dip); 818 return (DDI_WALK_ERROR); 819 } 820 821 /* create "reg" property */ 822 if (vdds_hv_niu_vr_getinfo(HVCOOKIE(cba->cookie), 823 &start, &size) != H_EOK) { 824 DERR(NULL, "Failed to get vrinfo for cookie(0x%lX)", 825 cba->cookie); 826 return (DDI_WALK_ERROR); 827 } 828 reg.addr_hi = HVCOOKIE(cba->cookie); 829 reg.addr_lo = 0; 830 reg.size_hi = 0; 831 reg.size_lo = size; 832 833 if (ndi_prop_update_int_array(DDI_DEV_T_NONE, dip, "reg", 834 (int *)®, sizeof (reg) / sizeof (int)) != DDI_SUCCESS) { 835 DERR(NULL, "Failed to create reg property(dip=0x%p)", dip); 836 return (DDI_WALK_ERROR); 837 } 838 839 /* 840 * Modify the parent's ranges property to map the "reg" property 841 * of the new child. 842 */ 843 if ((rv = ddi_getlongprop(DDI_DEV_T_ANY, pdip, DDI_PROP_DONTPASS, 844 "ranges", (caddr_t)&prng, &prnglen)) != DDI_SUCCESS) { 845 DERR(NULL, 846 "Failed to get parent's ranges property(pdip=0x%p) rv=%d", 847 pdip, rv); 848 return (DDI_WALK_ERROR); 849 } 850 nrng = prnglen/(sizeof (vdds_ranges_t)); 851 /* 852 * First scan all ranges to see if a range corresponding 853 * to this virtual NIU exists already. 854 */ 855 for (rnum = 0; rnum < nrng; rnum++) { 856 prp = &prng[rnum]; 857 if (prp->child_hi == HVCOOKIE(cba->cookie)) { 858 break; 859 } 860 } 861 if (rnum == nrng) { 862 /* Now to try to find an empty range */ 863 for (rnum = 0; rnum < nrng; rnum++) { 864 prp = &prng[rnum]; 865 if (prp->child_hi == 0) { 866 break; 867 } 868 } 869 } 870 if (rnum == nrng) { 871 DERR(NULL, "No free ranges entry found"); 872 return (DDI_WALK_ERROR); 873 } 874 875 /* 876 * child_hi will have HV cookie as HV cookie is more like 877 * a port in the HybridIO. 878 */ 879 prp->child_hi = HVCOOKIE(cba->cookie); 880 prp->child_lo = 0; 881 prp->parent_hi = 0x80000000 | (start >> 32); 882 prp->parent_lo = start & 0x00000000FFFFFFFF; 883 prp->size_hi = (size >> 32); 884 prp->size_lo = size & 0x00000000FFFFFFFF; 885 886 if (ndi_prop_update_int_array(DDI_DEV_T_NONE, pdip, "ranges", 887 (int *)prng, (nrng * 6)) != DDI_SUCCESS) { 888 DERR(NULL, "Failed to update parent ranges prop(pdip=0x%p)", 889 pdip); 890 return (DDI_WALK_ERROR); 891 } 892 kmem_free((void *)prng, prnglen); 893 894 vnet_macaddr_ultostr(cba->macaddr, macaddrbytes); 895 896 /* 897 * create "local-mac-address" property, this will be same as 898 * the vnet's mac-address. 899 */ 900 if (ndi_prop_update_byte_array(DDI_DEV_T_NONE, dip, "local-mac-address", 901 macaddrbytes, ETHERADDRL) != DDI_SUCCESS) { 902 DERR(NULL, "Failed to update mac-addresses property(dip=0x%p)", 903 dip); 904 return (DDI_WALK_ERROR); 905 } 906 907 rv = vdds_get_interrupts(cba->cookie, rnum, interrupts, &nintr); 908 if (rv != 0) { 909 DERR(NULL, "Failed to get interrupts for cookie=0x%lx", 910 cba->cookie); 911 return (DDI_WALK_ERROR); 912 } 913 914 /* create "interrupts" property */ 915 if (ndi_prop_update_int_array(DDI_DEV_T_NONE, dip, "interrupts", 916 interrupts, nintr) != DDI_SUCCESS) { 917 DERR(NULL, "Failed to update interrupts property(dip=0x%p)", 918 dip); 919 return (DDI_WALK_ERROR); 920 } 921 922 923 cba->dip = dip; 924 /* Hold the dip */ 925 ndi_hold_devi(dip); 926 DBG1(NULL, "Returning dip=0x%p", dip); 927 return (DDI_WALK_TERMINATE); 928 } 929 930 931 /* 932 * vdds_find_node -- A common function to find a NIU nexus or NIU node. 933 */ 934 static dev_info_t * 935 vdds_find_node(uint64_t cookie, dev_info_t *sdip, 936 int (*match_func)(dev_info_t *dip, void *arg)) 937 { 938 vdds_cb_arg_t arg; 939 dev_info_t *pdip; 940 int circ; 941 942 DBG1(NULL, "Called cookie=%lx\n", cookie); 943 944 arg.dip = NULL; 945 arg.cookie = cookie; 946 947 if (pdip = ddi_get_parent(sdip)) { 948 ndi_hold_devi(pdip); 949 ndi_devi_enter(pdip, &circ); 950 } 951 952 ddi_walk_devs(sdip, match_func, (void *)&arg); 953 if (pdip != NULL) { 954 ndi_devi_exit(pdip, circ); 955 ndi_rele_devi(pdip); 956 } 957 958 DBG1(NULL, "Returning dip=0x%p", arg.dip); 959 return (arg.dip); 960 } 961 962 /* 963 * vdds_create_new_node -- A common function to create NIU nexus/NIU node. 964 */ 965 static dev_info_t * 966 vdds_create_new_node(uint64_t cookie, uint64_t macaddr, dev_info_t *pdip, 967 int (*new_node_func)(dev_info_t *dip, void *arg, uint_t flags)) 968 { 969 devi_branch_t br; 970 int circ, rv; 971 vdds_cb_arg_t cba; 972 973 DBG1(NULL, "Called cookie=0x%lx", cookie); 974 975 cba.dip = NULL; 976 cba.cookie = cookie; 977 cba.macaddr = macaddr; 978 979 br.arg = (void *)&cba; 980 br.type = DEVI_BRANCH_SID; 981 br.create.sid_branch_create = new_node_func; 982 br.devi_branch_callback = NULL; 983 984 if (pdip == NULL) 985 pdip = ddi_root_node(); 986 ndi_devi_enter(pdip, &circ); 987 DBG1(NULL, "calling e_ddi_branch_create"); 988 if ((rv = e_ddi_branch_create(pdip, &br, NULL, 989 DEVI_BRANCH_CHILD | DEVI_BRANCH_CONFIGURE))) { 990 ndi_devi_exit(pdip, circ); 991 DERR(NULL, "e_ddi_branch_create failed=%d", rv); 992 return (NULL); 993 } 994 ndi_devi_exit(pdip, circ); 995 DBG1(NULL, "Returning(dip=0x%p", cba.dip); 996 return (cba.dip); 997 } 998 999 /* 1000 * vdds_get_interrupts -- A function that binds ino's to channels and 1001 * then provides them to create interrupts property. 1002 */ 1003 static int 1004 vdds_get_interrupts(uint64_t cookie, int ino_range, int *intrs, int *nintr) 1005 { 1006 uint32_t hvcookie = HVCOOKIE(cookie); 1007 uint64_t txmap; 1008 uint64_t rxmap; 1009 uint32_t ino = VDDS_INO_RANGE_START(ino_range); 1010 int rv; 1011 uint64_t i; 1012 1013 *nintr = 0; 1014 rv = vdds_hv_niu_vr_get_txmap(hvcookie, &txmap); 1015 if (rv != H_EOK) { 1016 DWARN(NULL, "Failed to get txmap for hvcookie=0x%X rv=%d\n", 1017 hvcookie, rv); 1018 return (EIO); 1019 } 1020 rv = vdds_hv_niu_vr_get_rxmap(hvcookie, &rxmap); 1021 if (rv != H_EOK) { 1022 DWARN(NULL, "Failed to get rxmap for hvcookie=0x%X, rv=%d\n", 1023 hvcookie, rv); 1024 return (EIO); 1025 } 1026 /* Check if the number of total channels to be more than 8 */ 1027 for (i = 0; i < 4; i++) { 1028 if (rxmap & (((uint64_t)0x1) << i)) { 1029 rv = vdds_hv_niu_vrrx_set_ino(hvcookie, i, ino); 1030 if (rv != H_EOK) { 1031 DWARN(NULL, "Failed to get Rx ino for " 1032 "hvcookie=0x%X vch_idx=0x%lx rv=%d\n", 1033 hvcookie, i, rv); 1034 return (EIO); 1035 } 1036 DWARN(NULL, 1037 "hvcookie=0x%X RX vch_idx=0x%lx ino=0x%X\n", 1038 hvcookie, i, ino); 1039 *intrs = ino; 1040 ino++; 1041 } else { 1042 *intrs = VDDS_MAX_INTR_NUM; 1043 } 1044 intrs++; 1045 *nintr += 1; 1046 } 1047 for (i = 0; i < 4; i++) { 1048 if (txmap & (((uint64_t)0x1) << i)) { 1049 rv = vdds_hv_niu_vrtx_set_ino(hvcookie, i, ino); 1050 if (rv != H_EOK) { 1051 DWARN(NULL, "Failed to get Tx ino for " 1052 "hvcookie=0x%X vch_idx=0x%lx rv=%d\n", 1053 hvcookie, i, rv); 1054 return (EIO); 1055 } 1056 DWARN(NULL, "hvcookie=0x%X TX vch_idx=0x%lx ino=0x%X\n", 1057 hvcookie, i, ino); 1058 *intrs = ino; 1059 ino++; 1060 } else { 1061 *intrs = VDDS_MAX_INTR_NUM; 1062 } 1063 intrs++; 1064 *nintr += 1; 1065 } 1066 return (0); 1067 } 1068 1069 /* 1070 * vdds_release_range_prop -- cleanups an entry in the ranges property 1071 * corresponding to a cookie. 1072 */ 1073 static void 1074 vdds_release_range_prop(dev_info_t *nexus_dip, uint64_t cookie) 1075 { 1076 vdds_ranges_t *prng; 1077 vdds_ranges_t *prp; 1078 int prnglen; 1079 int nrng; 1080 int rnum; 1081 boolean_t success = B_FALSE; 1082 int rv; 1083 1084 if ((rv = ddi_getlongprop(DDI_DEV_T_ANY, nexus_dip, DDI_PROP_DONTPASS, 1085 "ranges", (caddr_t)&prng, &prnglen)) != DDI_SUCCESS) { 1086 DERR(NULL, 1087 "Failed to get nexus ranges property(dip=0x%p) rv=%d", 1088 nexus_dip, rv); 1089 return; 1090 } 1091 nrng = prnglen/(sizeof (vdds_ranges_t)); 1092 for (rnum = 0; rnum < nrng; rnum++) { 1093 prp = &prng[rnum]; 1094 if (prp->child_hi == HVCOOKIE(cookie)) { 1095 prp->child_hi = 0; 1096 success = B_TRUE; 1097 break; 1098 } 1099 } 1100 if (success) { 1101 if (ndi_prop_update_int_array(DDI_DEV_T_NONE, nexus_dip, 1102 "ranges", (int *)prng, (nrng * 6)) != DDI_SUCCESS) { 1103 DERR(NULL, 1104 "Failed to update nexus ranges prop(dip=0x%p)", 1105 nexus_dip); 1106 } 1107 } 1108 } 1109