packages/ti/sdo/ipc/family/vayu/NotifySetup.c

   1 /*
   2  * Copyright (c) 2012-2014 Texas Instruments Incorporated - http://www.ti.com
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  *
   9  * *  Redistributions of source code must retain the above copyright
  10  *    notice, this list of conditions and the following disclaimer.
  11  *
  12  * *  Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  *
  16  * *  Neither the name of Texas Instruments Incorporated nor the names of
  17  *    its contributors may be used to endorse or promote products derived
  18  *    from this software without specific prior written permission.
  19  *
  20  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  21  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
  22  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  23  * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
  24  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
  25  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  26  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
  27  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
  28  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
  29  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
  30  * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  31  */
  32
  33 /*
  34  *  ======== NotifySetup.c ========
  35  */
  36 #include <xdc/std.h>
  37 #include <xdc/runtime/Assert.h>
  38 #include <xdc/runtime/Error.h>
  39 #include <xdc/runtime/Startup.h>
  40
  41 #include <ti/sdo/ipc/_Notify.h>
  42 #include <ti/sdo/ipc/family/vayu/NotifyDriverMbx.h>
  43 #include <ti/sdo/ipc/notifyDrivers/NotifyDriverShm.h>
  44 #include <ti/sdo/utils/_MultiProc.h>
  45
  46 #if defined(xdc_target__isaCompatible_64P)
  47
  48 #include <ti/sysbios/family/c64p/EventCombiner.h>
  49 #include <ti/sysbios/family/c64p/Hwi.h>
  50 #include <ti/sysbios/family/shared/vayu/IntXbar.h>
  51
  52 #elif defined(xdc_target__isaCompatible_arp32)
  53
  54 #include <ti/sysbios/family/arp32/Hwi.h>
  55
  56 #elif defined(xdc_target__isaCompatible_v7M)
  57
  58 #include <ti/sysbios/BIOS.h>
  59 #include <ti/sysbios/family/arm/ducati/Core.h>
  60 #include <ti/sysbios/family/arm/m3/Hwi.h>
  61 #include <ti/sysbios/family/shared/vayu/IntXbar.h>
  62
  63 #elif defined(xdc_target__isaCompatible_v7A)
  64
  65 #include <ti/sysbios/family/arm/gic/Hwi.h>
  66 #include <ti/sysbios/family/shared/vayu/IntXbar.h>
  67
  68 #else
  69 #error Invalid target
  70 #endif
  71
  72 #include "package/internal/NotifySetup.xdc.h"
  73
  74
  75 #define EVENT_GROUP_SIZE 32
  76
  77 /* register access methods */
  78 #define REG16(A)        (*(volatile UInt16 *)(A))
  79 #define REG32(A)        (*(volatile UInt32 *)(A))
  80
  81 /* ipc helper macros */
  82 #define MAILBOX_REG_VAL(m) (0x1 << (2 * (m)))
  83
  84 #define VIRTID(procId) (NotifySetup_procIdTable[(procId)])
  85
  86 #define MBX_BASEADDR_IDX(idx) ((NotifySetup_mailboxTable[(idx)] >> 16) & 0xFFFF)
  87
  88 #define MBX_USER_IDX(idx) ((NotifySetup_mailboxTable[(idx)] >> 8) & 0xFF)
  89
  90 #define SUBMBX_IDX(idx) (NotifySetup_mailboxTable[(idx)] & 0xFF)
  91
  92 #define MAILBOX_ADDR(idx) \
  93         (NotifySetup_mailboxBaseAddr[MBX_BASEADDR_IDX(idx)])
  94
  95 #define MAILBOX_STATUS(idx) \
  96         (MAILBOX_ADDR((idx)) + 0xC0 + (0x4 * SUBMBX_IDX((idx))))
  97
  98 #define MAILBOX_IRQENABLE_SET(idx) \
  99         (MAILBOX_ADDR((idx)) + 0x108 + (0x10 * MBX_USER_IDX((idx))))
 100
 101 #define MBOX_IRQ_ENABLE(idx) \
 102     ((REG32(MAILBOX_IRQENABLE_SET((idx))) & \
 103     MAILBOX_REG_VAL(SUBMBX_IDX((idx)))) != 0)
 104
 105 #define MBOX_MSG_COUNT(idx) (REG32(MAILBOX_STATUS((idx))))
 106
 107
 108 /*
 109  *************************************************************************
 110  *                      Module functions
 111  *************************************************************************
 112  */
 113
 114 /*
 115  *  ======== NotifySetup_Module_startup ========
 116  */
 117 Int NotifySetup_Module_startup(Int phase)
 118 {
 119 #if defined(xdc_target__isaCompatible_64P)
 120
 121     extern cregister volatile UInt DNUM;
 122
 123     if (!IntXbar_Module_startupDone()) {
 124         return (Startup_NOTDONE);
 125     }
 126
 127     /* connect mailbox interrupts at startup */
 128     if (DNUM == 0) {               /* DSP1 */
 129         IntXbar_connect(24, 284);  // eve1 mailbox 0 user 1
 130         IntXbar_connect(25, 293);  // eve2 mailbox 0 user 1
 131         IntXbar_connect(26, 249);  // system mailbox 5 user 0
 132         NotifySetup_module->interruptTable[6] = 57; // IPU1-0
 133         NotifySetup_module->interruptTable[9] = 57; // IPU1-1
 134
 135         /* plug eve3 and eve4 mbxs only if eve3 and eve4 exists */
 136         if ((MultiProc_getId("EVE3") != MultiProc_INVALIDID) ||
 137             (MultiProc_getId("EVE4") != MultiProc_INVALIDID)) {
 138             IntXbar_connect(27, 302);  // eve3 mailbox 0 user 1
 139             IntXbar_connect(28, 311);  // eve4 mailbox 0 user 1
 140         }
 141
 142         /* plug mbx7 only if DSP2 or IPU2 exists */
 143         if ((MultiProc_getId("DSP2") != MultiProc_INVALIDID) ||
 144             (MultiProc_getId("IPU2") != MultiProc_INVALIDID) ||
 145             (MultiProc_getId("IPU2-0") != MultiProc_INVALIDID)) {
 146             IntXbar_connect(29, 257);  // system mailbox 7 user 0
 147             NotifySetup_module->interruptTable[7] = 60; // IPU2-0
 148         }
 149
 150         /* plug mbx8 only if IPU2-1 exists */
 151         if (MultiProc_getId("IPU2-1") != MultiProc_INVALIDID) {
 152             IntXbar_connect(30, 261);  // system mailbox 8 user 0
 153             NotifySetup_module->interruptTable[10] = 61; // IPU2-1
 154         }
 155     }
 156     else if (DNUM == 1) {          /* DSP2 */
 157         IntXbar_connect(24, 287);  // eve1 mailbox 1 user 1
 158         IntXbar_connect(25, 296);  // eve2 mailbox 1 user 1
 159         IntXbar_connect(26, 253);  // system mailbox 6 user 0
 160         NotifySetup_module->interruptTable[7] = 57; // IPU2-0
 161         NotifySetup_module->interruptTable[10] = 57; // IPU2-1
 162
 163         /* plug eve3 and eve4 mbxs only if eve3 and eve4 exists */
 164         if ((MultiProc_getId("EVE3") != MultiProc_INVALIDID) ||
 165             (MultiProc_getId("EVE4") != MultiProc_INVALIDID)) {
 166             IntXbar_connect(27, 305);  // eve3 mailbox 1 user 1
 167             IntXbar_connect(28, 314);  // eve4 mailbox 1 user 1
 168         }
 169
 170         /* plug mbx7 only if DSP1 or IPU1 exists */
 171         if ((MultiProc_getId("DSP1") != MultiProc_INVALIDID) ||
 172             (MultiProc_getId("IPU1") != MultiProc_INVALIDID) ||
 173             (MultiProc_getId("IPU1-0") != MultiProc_INVALIDID)) {
 174             IntXbar_connect(29, 258);  // system mailbox 7 user 1
 175             NotifySetup_module->interruptTable[6] = 60; // IPU1-0
 176         }
 177
 178         /* plug mbx8 only if IPU1-1 exists */
 179         if (MultiProc_getId("IPU1-1") != MultiProc_INVALIDID) {
 180             IntXbar_connect(30, 262);  // system mailbox 8 user 1
 181             NotifySetup_module->interruptTable[9] = 61; // IPU1-1
 182         }
 183     }
 184
 185     return (Startup_DONE);
 186
 187 #elif defined(xdc_target__isaCompatible_arp32)
 188
 189     /* nothing to do on this processor */
 190     return (Startup_DONE);
 191
 192 #elif defined(xdc_target__isaCompatible_v7M)
 193
 194     if (!IntXbar_Module_startupDone()) {
 195         return (Startup_NOTDONE);
 196     }
 197
 198     /* connect mailbox interrupts at startup */
 199     if (Core_ipuId == 1) {
 200         if ((BIOS_smpEnabled) || (Core_getId() == 0)) {
 201             /* IPU1-0 */
 202             IntXbar_connect(42, 285);  // eve1 mailbox 0 user 2
 203             IntXbar_connect(43, 294);  // eve2 mailbox 0 user 2
 204             IntXbar_connect(44, 250);  // system mailbox 5 user 1
 205
 206             /* plug eve3 and eve4 mbxs only if eve3 and eve4 exists */
 207             if ((MultiProc_getId("EVE3") != MultiProc_INVALIDID) ||
 208                 (MultiProc_getId("EVE4") != MultiProc_INVALIDID)) {
 209                 IntXbar_connect(45, 303);  // eve3 mailbox 0 user 2
 210                 IntXbar_connect(46, 312);  // eve4 mailbox 0 user 2
 211             }
 212
 213             /* plug mbx7 only if DSP2, IPU1-1, or IPU2 exists */
 214             if ((MultiProc_getId("DSP2") != MultiProc_INVALIDID) ||
 215                 (MultiProc_getId("IPU1-1") != MultiProc_INVALIDID) ||
 216                 (MultiProc_getId("IPU2") != MultiProc_INVALIDID) ||
 217                 (MultiProc_getId("IPU2-0") != MultiProc_INVALIDID)) {
 218                 IntXbar_connect(47, 259);  // system mailbox 7 user 2
 219             }
 220
 221             /* plug mbx8 only if IPU2-1 exists */
 222             if (MultiProc_getId("IPU2-1") != MultiProc_INVALIDID) {
 223                 IntXbar_connect(48, 263);  // system mailbox 8 user 2
 224             }
 225         }
 226         else { /* IPU1-1 */
 227             IntXbar_connect(49, 289);  // eve1 mailbox 1 user 3
 228             IntXbar_connect(50, 298);  // eve2 mailbox 1 user 3
 229             IntXbar_connect(51, 252);  // system mailbox 5 user 3
 230
 231             /* plug eve3 and eve4 mbxs only if eve3 and eve4 exists */
 232             if ((MultiProc_getId("EVE3") != MultiProc_INVALIDID) ||
 233                 (MultiProc_getId("EVE4") != MultiProc_INVALIDID)) {
 234                 IntXbar_connect(52, 307);  // eve3 mailbox 1 user 3
 235                 IntXbar_connect(53, 316);  // eve4 mailbox 1 user 3
 236             }
 237
 238             /* plug mbx8 only if DSP2, IPU1-0, or IPU2 exists */
 239             if ((MultiProc_getId("DSP2") != MultiProc_INVALIDID) ||
 240                 (MultiProc_getId("IPU1-0") != MultiProc_INVALIDID) ||
 241                 (MultiProc_getId("IPU2") != MultiProc_INVALIDID) ||
 242                 (MultiProc_getId("IPU2-0") != MultiProc_INVALIDID)) {
 243                 IntXbar_connect(54, 263);  // system mailbox 8 user 2
 244             }
 245         }
 246     }
 247     else {
 248         if ((BIOS_smpEnabled) || (Core_getId() == 0)) {
 249             /* IPU2-0 */
 250             IntXbar_connect(42, 288);  // eve1 mailbox 1 user 2
 251             IntXbar_connect(43, 297);  // eve2 mailbox 1 user 2
 252             IntXbar_connect(44, 254);  // system mailbox 6 user 1
 253
 254             /* plug eve3 and eve4 mbxs only if eve3 and eve4 exists */
 255             if ((MultiProc_getId("EVE3") != MultiProc_INVALIDID) ||
 256                 (MultiProc_getId("EVE4") != MultiProc_INVALIDID)) {
 257                 IntXbar_connect(45, 306);  // eve3 mailbox 1 user 2
 258                 IntXbar_connect(46, 315);  // eve4 mailbox 1 user 2
 259             }
 260
 261             /* plug mbx7 only if DSP1 or IPU1 exists */
 262             if ((MultiProc_getId("DSP1") != MultiProc_INVALIDID) ||
 263                 (MultiProc_getId("IPU1") != MultiProc_INVALIDID) ||
 264                 (MultiProc_getId("IPU1-0") != MultiProc_INVALIDID)) {
 265                 IntXbar_connect(47, 260);  // system mailbox 7 user 3
 266             }
 267
 268             /* plug mbx8 only if IPU1-1 exists */
 269             if (MultiProc_getId("IPU1-1") != MultiProc_INVALIDID) {
 270                 IntXbar_connect(48, 264);  // system mailbox 8 user 3
 271             }
 272         }
 273         else { /* IPU2-1 */
 274             IntXbar_connect(49, 289);  // eve1 mailbox 1 user 3
 275             IntXbar_connect(50, 298);  // eve2 mailbox 1 user 3
 276             IntXbar_connect(51, 256);  // system mailbox 6 user 3
 277
 278             /* plug eve3 and eve4 mbxs only if eve3 and eve4 exists */
 279             if ((MultiProc_getId("EVE3") != MultiProc_INVALIDID) ||
 280                 (MultiProc_getId("EVE4") != MultiProc_INVALIDID)) {
 281                 IntXbar_connect(52, 307);  // eve3 mailbox 1 user 3
 282                 IntXbar_connect(53, 316);  // eve4 mailbox 1 user 3
 283             }
 284
 285             /* plug mbx8 only if DSP2 or IPU2 exists */
 286             if ((MultiProc_getId("DSP1") != MultiProc_INVALIDID) ||
 287                 (MultiProc_getId("IPU1") != MultiProc_INVALIDID) ||
 288                 (MultiProc_getId("IPU1-0") != MultiProc_INVALIDID)) {
 289                 IntXbar_connect(54, 264);  // system mailbox 8 user 3
 290             }
 291         }
 292     }
 293
 294     return (Startup_DONE);
 295
 296 #elif defined(xdc_target__isaCompatible_v7A)
 297
 298     if (!IntXbar_Module_startupDone()) {
 299         return (Startup_NOTDONE);
 300     }
 301
 302     /* connect mailbox interrupts at startup */
 303     IntXbar_connect(127, 286);  // eve1 mailbox 0 user 3
 304     IntXbar_connect(128, 295);  // eve2 mailbox 0 user 3
 305     IntXbar_connect(129, 251);  // system mailbox 5 user 2
 306
 307     /* plug eve3 and eve4 mbxs only if eve3 and eve4 exists */
 308     if ((MultiProc_getId("EVE3") != MultiProc_INVALIDID) ||
 309         (MultiProc_getId("EVE4") != MultiProc_INVALIDID)) {
 310         IntXbar_connect(130, 304);  // eve3 mailbox 0 user 3
 311         IntXbar_connect(131, 313);  // eve4 mailbox 0 user 3
 312     }
 313
 314     /* plug mbx6 only if DSP2 or IPU2 exists */
 315     if ((MultiProc_getId("DSP2") != MultiProc_INVALIDID) ||
 316         (MultiProc_getId("IPU2") != MultiProc_INVALIDID) ||
 317         (MultiProc_getId("IPU2-0") != MultiProc_INVALIDID)) {
 318         IntXbar_connect(134, 255);  // system mailbox 6 user 2
 319     }
 320
 321     return (Startup_DONE);
 322
 323 #else
 324 #error Invalid target
 325 #endif
 326 }
 327
 328 /*
 329  *  ======== NotifySetup_interruptTable ========
 330  */
 331 UInt16 NotifySetup_interruptTable(Int srcVirtId)
 332 {
 333     return (NotifySetup_module->interruptTable[srcVirtId]);
 334 }
 335
 336 /*
 337  *  ======== NotifySetup_attach ========
 338  *  Create driver instance specified at config time.
 339  *
 340  *  This functions is generated by the NotifySetup.xdt template.
 341  */
 342
 343 /*
 344  *  ======== NotifySetup_sharedMemReq ========
 345  *  Compute how much shared memory is required by the driver.
 346  *
 347  *  This functions is generated by the NotifySetup.xdt template.
 348  */
 349
 350 /*
 351  * ======== NotifySetup_numIntLines ========
 352  * Return number of available interrupt lines to the current processor.
 353  */
 354 UInt16 NotifySetup_numIntLines(UInt16 remoteProcId)
 355 {
 356     return (1);
 357 }
 358
 359 /*
 360  *  ======== NotifySetup_driverType ========
 361  *  Find driver type for given connection.
 362  *
 363  *  Search the connection array for the given remote processor. If
 364  *  found, return the requested notify driver type.
 365  */
 366 NotifySetup_Driver NotifySetup_driverType(UInt16 remoteProcId)
 367 {
 368     Int i;
 369     NotifySetup_Driver driver = NotifySetup_Driver_SHAREDMEMORY;
 370
 371     /* look for remote processor in connection array */
 372     for (i = 0; i < NotifySetup_module->connAry.length; i++) {
 373         if (remoteProcId == NotifySetup_module->connAry.elem[i].procId) {
 374             driver = NotifySetup_module->connAry.elem[i].driver;
 375             break;
 376         }
 377     }
 378
 379     return (driver);
 380 }
 381
 382 /*
 383  *  ======== NotifySetup_plugHwi ========
 384  */
 385 Void NotifySetup_plugHwi(UInt16 remoteProcId, Int cpuIntrNum,
 386         NotifySetup_DriverIsr isr)
 387 {
 388     Error_Block eb;
 389     UInt        key;
 390     Hwi_Params  hwiParams;
 391     UInt16      srcVirtId;
 392 #if defined(xdc_target__isaCompatible_64P)
 393     Int         eventId;
 394     UInt        combinedEventId;
 395 #elif defined(xdc_target__isaCompatible_arp32)
 396     UInt        mbxIdx;
 397     Int         eventId;
 398     Bits16      mask;
 399 #elif defined(xdc_target__isaCompatible_v7M) \
 400     || defined(xdc_target__isaCompatible_v7A)
 401     UInt16      idx;
 402     UInt        mbxIdx;
 403 #endif
 404
 405     Error_init(&eb);
 406
 407     /* disable interrupts */
 408     key = Hwi_disable();
 409
 410     /* map remote processor id to virtual id */
 411     srcVirtId = VIRTID(remoteProcId);
 412
 413     /* save driver ISR in dispatch table */
 414     NotifySetup_module->isrDispatchTable[srcVirtId] = isr;
 415
 416 #if defined(xdc_target__isaCompatible_64P)
 417
 418     /* program the event dispatcher */
 419     eventId = NotifySetup_module->interruptTable[srcVirtId];
 420     EventCombiner_dispatchPlug(eventId, NotifySetup_dispatchIsr, eventId, TRUE);
 421
 422     /* make sure the interrupt is plugged only once */
 423     NotifySetup_module->numPlugged[0]++;
 424
 425     if (NotifySetup_module->numPlugged[0] == 1) {
 426         combinedEventId = eventId / EVENT_GROUP_SIZE;
 427
 428         Hwi_Params_init(&hwiParams);
 429         hwiParams.eventId = combinedEventId;
 430         hwiParams.arg = combinedEventId;
 431         hwiParams.enableInt = TRUE;
 432
 433         Hwi_create(cpuIntrNum, &ti_sysbios_family_c64p_EventCombiner_dispatch,
 434                 &hwiParams, &eb);
 435         /* TODO: add error handling */
 436
 437         Hwi_enableInterrupt(cpuIntrNum);
 438     }
 439
 440 #elif defined(xdc_target__isaCompatible_arp32)
 441
 442     if ((remoteProcId == NotifySetup_dsp1ProcId) ||
 443         (remoteProcId == NotifySetup_ipu1_0ProcId) ||
 444         (remoteProcId == NotifySetup_hostProcId)) {
 445
 446         mbxIdx = 0;
 447     }
 448     else if ((remoteProcId == NotifySetup_dsp2ProcId) ||
 449         (remoteProcId == NotifySetup_ipu2_0ProcId) ||
 450         (remoteProcId == NotifySetup_ipu1_1ProcId) ||
 451         (remoteProcId == NotifySetup_ipu2_1ProcId)) {
 452
 453         mbxIdx = 1;
 454     }
 455     else {
 456         mbxIdx = 2; /* remote processor must be EVEx */
 457     }
 458
 459     /* make sure the interrupt is plugged only once */
 460     NotifySetup_module->numPlugged[mbxIdx]++;
 461
 462     if (NotifySetup_module->numPlugged[mbxIdx] == 1) {
 463         eventId = NotifySetup_module->interruptTable[srcVirtId];
 464
 465         /* compute the hwi mask */
 466         mask = (1 << NotifySetup_eveIntVectId_INTC0)
 467                 | (1 << NotifySetup_eveIntVectId_INTC1);
 468
 469         Hwi_Params_init(&hwiParams);
 470         hwiParams.arg = eventId;
 471         hwiParams.vectorNum = cpuIntrNum;
 472         hwiParams.maskSetting = Hwi_MaskingOption_BITMASK;
 473         hwiParams.disableIerMask = mask;
 474         hwiParams.restoreIerMask = mask;
 475
 476         Hwi_create(eventId, NotifySetup_dispatchIsr, &hwiParams, &eb);
 477         /* TODO: add error handling */
 478
 479         Hwi_enableInterrupt(NotifySetup_module->interruptTable[srcVirtId]);
 480     }
 481
 482 #elif defined(xdc_target__isaCompatible_v7M) \
 483     || defined(xdc_target__isaCompatible_v7A)
 484
 485     /* compute table index for given source and destination */
 486     idx = (srcVirtId * NotifySetup_NUM_CORES) + MultiProc_self();
 487
 488     /* compute mailbox index */
 489     mbxIdx = MBX_BASEADDR_IDX(idx);
 490
 491     /* make sure the interrupt is plugged only once */
 492     NotifySetup_module->numPlugged[mbxIdx]++;
 493
 494     if (NotifySetup_module->numPlugged[mbxIdx] == 1) {
 495
 496         Hwi_Params_init(&hwiParams);
 497         hwiParams.maskSetting = Hwi_MaskingOption_LOWER;
 498         hwiParams.arg = cpuIntrNum;
 499
 500         Hwi_create(cpuIntrNum, NotifySetup_dispatchIsr, &hwiParams, &eb);
 501         /* TODO: add error handling */
 502
 503         Hwi_enableInterrupt(cpuIntrNum);
 504     }
 505
 506 #else
 507 #error Invalid target
 508 #endif
 509
 510     /* restore interrupts */
 511     Hwi_restore(key);
 512 }
 513
 514 /*
 515  *  ======== NotifySetup_unplugHwi ========
 516  */
 517 Void NotifySetup_unplugHwi(UInt16 remoteProcId, Int cpuIntrNum)
 518 {
 519     UInt        key;
 520     Hwi_Handle  hwi;
 521     UInt16      srcVirtId;
 522 #if defined(xdc_target__isaCompatible_64P)
 523     Int         eventId;
 524 #elif defined(xdc_target__isaCompatible_arp32)
 525     UInt        mbxIdx;
 526 #elif defined(xdc_target__isaCompatible_v7M) \
 527     || defined(xdc_target__isaCompatible_v7A)
 528     UInt16      idx;
 529     UInt        mbxIdx;
 530 #endif
 531
 532     /* disable global interrupts (TODO: should be a gated module) */
 533     key = Hwi_disable();
 534
 535     /* map processor id to virtual id */
 536     srcVirtId = VIRTID(remoteProcId);
 537
 538     /* remove driver isr from dispatch table */
 539     NotifySetup_module->isrDispatchTable[srcVirtId] = NULL;
 540
 541 #if defined(xdc_target__isaCompatible_64P)
 542
 543     /* unplug interrupt if last user */
 544     NotifySetup_module->numPlugged[0]--;
 545
 546     if (NotifySetup_module->numPlugged[0] == 0) {
 547         hwi = Hwi_getHandle(cpuIntrNum);
 548         Hwi_delete(&hwi);
 549     }
 550
 551     /* unprogram the event dispatcher */
 552     eventId = NotifySetup_module->interruptTable[srcVirtId];
 553     EventCombiner_disableEvent(eventId);
 554
 555 #elif defined(xdc_target__isaCompatible_arp32)
 556
 557     if ((remoteProcId == NotifySetup_dsp1ProcId) ||
 558         (remoteProcId == NotifySetup_ipu1_0ProcId) ||
 559         (remoteProcId == NotifySetup_hostProcId)) {
 560
 561         mbxIdx = 0;
 562     }
 563     else if ((remoteProcId == NotifySetup_dsp2ProcId) ||
 564         (remoteProcId == NotifySetup_ipu2_0ProcId) ||
 565         (remoteProcId == NotifySetup_ipu1_1ProcId) ||
 566         (remoteProcId == NotifySetup_ipu2_1ProcId)) {
 567
 568         mbxIdx = 1;
 569     }
 570     else {
 571         mbxIdx = 2; /* remote processor must be EVEx */
 572     }
 573
 574     /* unplug interrupt if last user */
 575     NotifySetup_module->numPlugged[mbxIdx]--;
 576
 577     if (NotifySetup_module->numPlugged[0] == 0) {
 578         hwi = Hwi_getHandle(cpuIntrNum);
 579         Hwi_delete(&hwi);
 580     }
 581
 582 #elif defined(xdc_target__isaCompatible_v7M) \
 583     || defined(xdc_target__isaCompatible_v7A)
 584
 585     /* decrement plug count */
 586     idx = (srcVirtId * NotifySetup_NUM_CORES) + MultiProc_self();
 587     mbxIdx = MBX_BASEADDR_IDX(idx);
 588     NotifySetup_module->numPlugged[mbxIdx]--;
 589
 590     /* unplug interrupt if last user */
 591     if (NotifySetup_module->numPlugged[0] == 0) {
 592         hwi = Hwi_getHandle(cpuIntrNum);
 593         Hwi_delete(&hwi);
 594     }
 595
 596 #else
 597 #error Invalid target
 598 #endif
 599
 600     /* restore global interrupts */
 601     Hwi_restore(key);
 602 }
 603
 604 /*
 605  *  ======== NotifySetup_Shm_attach ========
 606  */
 607 Int NotifySetup_Shm_attach(UInt16 remoteProcId, Ptr sharedAddr)
 608 {
 609     NotifyDriverShm_Params notifyShmParams;
 610     NotifyDriverShm_Handle shmDrvHandle;
 611     ti_sdo_ipc_Notify_Handle notifyHandle;
 612     Int status = Notify_S_SUCCESS;
 613     Error_Block eb;
 614
 615     Error_init(&eb);
 616
 617     NotifyDriverShm_Params_init(&notifyShmParams);
 618     notifyShmParams.sharedAddr = sharedAddr;
 619     notifyShmParams.remoteProcId  = remoteProcId;
 620
 621     /* Set the intVectorId if on the DSP */
 622     if ((MultiProc_self() == NotifySetup_dsp1ProcId) ||
 623         (MultiProc_self() == NotifySetup_dsp2ProcId)) {
 624             notifyShmParams.intVectorId = NotifySetup_dspIntVectId;
 625     }
 626
 627     /* Set the intVectorId if on the EVE */
 628     if ((MultiProc_self() == NotifySetup_eve1ProcId) ||
 629         (MultiProc_self() == NotifySetup_eve2ProcId) ||
 630         (MultiProc_self() == NotifySetup_eve3ProcId) ||
 631         (MultiProc_self() == NotifySetup_eve4ProcId)) {
 632
 633         if (VIRTID(remoteProcId) < 4) {
 634             notifyShmParams.intVectorId = NotifySetup_eveIntVectId_INTC1;
 635         }
 636         else {
 637             notifyShmParams.intVectorId = NotifySetup_eveIntVectId_INTC0;
 638         }
 639     }
 640
 641     /* create the notify driver instance */
 642     shmDrvHandle = NotifyDriverShm_create(&notifyShmParams, &eb);
 643
 644     if (shmDrvHandle == NULL) {
 645         return (Notify_E_FAIL);
 646     }
 647
 648     /* create the front-end notify instance */
 649     notifyHandle = ti_sdo_ipc_Notify_create(
 650             NotifyDriverShm_Handle_upCast(shmDrvHandle), remoteProcId, 0,
 651             NULL, &eb);
 652
 653     if (notifyHandle == NULL) {
 654         NotifyDriverShm_delete(&shmDrvHandle);
 655         status = Notify_E_FAIL;
 656     }
 657
 658     return (status);
 659 }
 660
 661 /*!
 662  *  ======== NotifySetup_Shm_sharedMemReq ========
 663  */
 664 SizeT NotifySetup_Shm_sharedMemReq(UInt16 remoteProcId, Ptr sharedAddr)
 665 {
 666     SizeT memReq;
 667     NotifyDriverShm_Params notifyShmParams;
 668
 669     NotifyDriverShm_Params_init(&notifyShmParams);
 670     notifyShmParams.sharedAddr = sharedAddr;
 671
 672     memReq = NotifyDriverShm_sharedMemReq(&notifyShmParams);
 673
 674     return (memReq);
 675 }
 676
 677 /*
 678  *  ======== NotifySetup_Mbx_attach ========
 679  */
 680 Int NotifySetup_Mbx_attach(UInt16 remoteProcId, Ptr sharedAddr)
 681 {
 682     Int status = Notify_S_SUCCESS;
 683     NotifyDriverMbx_Params params;
 684     NotifyDriverMbx_Handle driver;
 685     ti_sdo_ipc_Notify_Handle notify;
 686     UInt16 virtId;
 687     Error_Block eb;
 688
 689     Error_init(&eb);
 690
 691     NotifyDriverMbx_Params_init(&params);
 692     params.remoteProcId = remoteProcId;
 693
 694     /* set the intVectorId if on the DSP */
 695     if ((MultiProc_self() == NotifySetup_dsp1ProcId) ||
 696         (MultiProc_self() == NotifySetup_dsp2ProcId)) {
 697         params.intVectorId = NotifySetup_dspIntVectId;
 698     }
 699
 700     /* set the intVectorId if on the EVE */
 701     if ((MultiProc_self() == NotifySetup_eve1ProcId) ||
 702         (MultiProc_self() == NotifySetup_eve2ProcId) ||
 703         (MultiProc_self() == NotifySetup_eve3ProcId) ||
 704         (MultiProc_self() == NotifySetup_eve4ProcId)) {
 705
 706         if (VIRTID(remoteProcId) < 4) {
 707             params.intVectorId = NotifySetup_eveIntVectId_INTC1;
 708         }
 709         else {
 710             params.intVectorId = NotifySetup_eveIntVectId_INTC0;
 711         }
 712     }
 713
 714     /* set the intVectorId if on the IPU */
 715     if ((MultiProc_self() == NotifySetup_ipu1_0ProcId) ||
 716         (MultiProc_self() == NotifySetup_ipu1_1ProcId) ||
 717         (MultiProc_self() == NotifySetup_ipu2_0ProcId) ||
 718         (MultiProc_self() == NotifySetup_ipu2_1ProcId)) {
 719
 720         virtId = VIRTID(remoteProcId);
 721         params.intVectorId = NotifySetup_module->interruptTable[virtId];
 722     }
 723
 724     /* set the intVectorId if on the HOST */
 725     if (MultiProc_self() == NotifySetup_hostProcId) {
 726         virtId = VIRTID(remoteProcId);
 727         params.intVectorId = NotifySetup_module->interruptTable[virtId];
 728     }
 729
 730     /* create the notify driver instance */
 731     driver = NotifyDriverMbx_create(&params, &eb);
 732
 733     if (driver == NULL) {
 734         return (Notify_E_FAIL);
 735     }
 736
 737     /* create the front-end notify instance */
 738     notify = ti_sdo_ipc_Notify_create(NotifyDriverMbx_Handle_upCast(driver),
 739             remoteProcId, 0, NULL, &eb);
 740
 741     if (notify == NULL) {
 742         NotifyDriverMbx_delete(&driver);
 743         status = Notify_E_FAIL;
 744     }
 745
 746     return (status);
 747 }
 748
 749 /*!
 750  *  ======== NotifySetup_Mbx_sharedMemReq ========
 751  */
 752 SizeT NotifySetup_Mbx_sharedMemReq(UInt16 remoteProcId, Ptr sharedAddr)
 753 {
 754     SizeT memReq = 0;
 755
 756     return (memReq);
 757 }
 758
 759 /*
 760  *************************************************************************
 761  *                       Internal functions
 762  *************************************************************************
 763  */
 764
 765 /*
 766  *  ======== NotifySetup_dispatchIsr ========
 767  *  Dispatch the current interrupt to the appropriate notify driver
 768  *
 769  *  The given interrupt may be shared by multiple notify drivers. This
 770  *  ISR inspects the mailbox which raised the interrupt and looks for
 771  *  all FIFOs which have data and raise the given interrupt. For each
 772  *  one, the interrupt is dispatched to the registered driver for that
 773  *  FIFO.
 774  *
 775  *  @param(arg) The eventId which raised the interrupt.
 776  */
 777 Void NotifySetup_dispatchIsr(UArg arg)
 778 {
 779     Int numProcessed;
 780     UInt16 idx;
 781     UInt16 srcVirtId;
 782     UInt16 dstVirtId = VIRTID(MultiProc_self());
 783     NotifySetup_DriverIsr driver;
 784
 785     do {
 786         numProcessed = 0;
 787
 788         for (srcVirtId = 0; srcVirtId < NotifySetup_NUM_CORES; srcVirtId++) {
 789
 790             /* skip null drivers, processor not in system or self */
 791             driver = NotifySetup_module->isrDispatchTable[srcVirtId];
 792
 793             if (driver == NULL) {
 794                 continue;
 795             }
 796
 797             /* check if processor would raise the given hardware eventId */
 798             if (arg == NotifySetup_module->interruptTable[srcVirtId]) {
 799
 800                 /* compute table index for given source and destination */
 801                 idx = (srcVirtId * NotifySetup_NUM_CORES) + dstVirtId;
 802
 803                 /* check if submailbox has a message and irq is enabled */
 804                 if ((MBOX_MSG_COUNT(idx) != 0) && MBOX_IRQ_ENABLE(idx)) {
 805
 806                     /* invoke driver isr to deliver the event */
 807                     (*driver)(idx);
 808
 809                     /* event has been delivered */
 810                     numProcessed++;
 811                 }
 812             }
 813         }
 814     } while (numProcessed != 0);
 815 }