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

   1 /*
   2  * Copyright (c) 2012-2014, Texas Instruments Incorporated
   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  *  ======== InterruptDsp.c ========
  34  *  Mailbox based interrupt manager
  35  */
  36 #include <xdc/std.h>
  37 #include <xdc/runtime/Startup.h>
  38 #include <xdc/runtime/System.h>
  39 #include <xdc/runtime/Assert.h>
  40
  41 #include <ti/sysbios/family/shared/vayu/IntXbar.h>
  42
  43 #include <ti/sysbios/family/c64p/Hwi.h>
  44 #include <ti/sysbios/family/c64p/EventCombiner.h>
  45
  46 #include <ti/sdo/utils/_MultiProc.h>
  47 #include <ti/sdo/ipc/_Ipc.h>
  48
  49 #include <ti/sdo/ipc/notifyDrivers/IInterrupt.h>
  50
  51 #include "package/internal/InterruptDsp.xdc.h"
  52
  53 /* Register access method. */
  54 #define REG16(A)   (*(volatile UInt16 *) (A))
  55 #define REG32(A)   (*(volatile UInt32 *) (A))
  56
  57 #define PROCID(IDX)               (InterruptDsp_procIdTable[IDX])
  58 #define MBX_TABLE_IDX(SRC, DST)   ((PROCID(SRC) * InterruptDsp_NUM_CORES) + \
  59                                     PROCID(DST))
  60 #define SUBMBX_IDX(IDX)           (InterruptDsp_mailboxTable[IDX] & 0xFF)
  61 #define MBX_USER_IDX(IDX)         ((InterruptDsp_mailboxTable[IDX] >> 8) & 0xFF)
  62 #define MBX_BASEADDR_IDX(IDX)     ((InterruptDsp_mailboxTable[IDX] >> 16) & 0xFFFF)
  63
  64 #define MAILBOX_REG_VAL(M)        (0x1 << (2 * M))
  65
  66 #define MAILBOX_MESSAGE(IDX)      (InterruptDsp_mailboxBaseAddr[  \
  67                                     MBX_BASEADDR_IDX(IDX)] + 0x40 \
  68                                     + (0x4 * SUBMBX_IDX(IDX)))
  69 #define MAILBOX_STATUS(IDX)       (InterruptDsp_mailboxBaseAddr[  \
  70                                     MBX_BASEADDR_IDX(IDX)] + 0xC0 \
  71                                     + (0x4 * SUBMBX_IDX(IDX)))
  72
  73 #define MAILBOX_IRQSTATUS_CLR_DSP(IDX)   (InterruptDsp_mailboxBaseAddr[ \
  74                                            MBX_BASEADDR_IDX(IDX)] +     \
  75                                            (0x10 * MBX_USER_IDX(IDX)) + 0x104)
  76 #define MAILBOX_IRQENABLE_SET_DSP(IDX)   (InterruptDsp_mailboxBaseAddr[ \
  77                                            MBX_BASEADDR_IDX(IDX)] +     \
  78                                            (0x10 * MBX_USER_IDX(IDX)) + 0x108)
  79 #define MAILBOX_IRQENABLE_CLR_DSP(IDX)   (InterruptDsp_mailboxBaseAddr[ \
  80                                            MBX_BASEADDR_IDX(IDX)] +     \
  81                                            (0x10 * MBX_USER_IDX(IDX)) + 0x10C)
  82 #define MAILBOX_EOI_REG(IDX)             (InterruptDsp_mailboxBaseAddr[ \
  83                                            MBX_BASEADDR_IDX(IDX)] + 0x140)
  84 #define EVENT_GROUP_SIZE                 32
  85
  86 /*
  87  *************************************************************************
  88  *                      Module functions
  89  *************************************************************************
  90  */
  91
  92 /*
  93  *  ======== InterruptDsp_Module_startup ========
  94  */
  95 Int InterruptDsp_Module_startup(Int phase)
  96 {
  97     extern cregister volatile UInt DNUM;
  98
  99     if (IntXbar_Module_startupDone()) {
 100         /* connect mailbox interrupts at startup */
 101         if (DNUM == 0) {               /* DSP1 */
 102             IntXbar_connect(24, 284);  // eve1 mailbox 0 user 1
 103             IntXbar_connect(25, 293);  // eve2 mailbox 0 user 1
 104             IntXbar_connect(26, 249);  // system mailbox 5 user 0
 105
 106             InterruptDsp_module->interruptTable[6] = 57;    // IPU1-0
 107             InterruptDsp_module->interruptTable[9] = 57;    // IPU1-1
 108
 109             /* plug eve3 and eve4 mbxs only if eve3 and eve4 exists */
 110             if ((MultiProc_getId("EVE3") != MultiProc_INVALIDID) ||
 111                 (MultiProc_getId("EVE4") != MultiProc_INVALIDID)) {
 112                 IntXbar_connect(27, 302);  // eve3 mailbox 0 user 1
 113                 IntXbar_connect(28, 311);  // eve4 mailbox 0 user 1
 114             }
 115
 116             /* plug mbx7 only if DSP2 or IPU2 exists */
 117             if ((MultiProc_getId("DSP2") != MultiProc_INVALIDID) ||
 118                 (MultiProc_getId("IPU2") != MultiProc_INVALIDID) ||
 119                 (MultiProc_getId("IPU2-0") != MultiProc_INVALIDID)) {
 120                 IntXbar_connect(29, 257);  // system mailbox 7 user 0
 121                 InterruptDsp_module->interruptTable[7] = 60;    // IPU2-0
 122             }
 123
 124             /* plug mbx8 only if IPU2-1 exists */
 125             if (MultiProc_getId("IPU2-1") != MultiProc_INVALIDID) {
 126                 IntXbar_connect(30, 261);  // system mailbox 8 user 0
 127                 InterruptDsp_module->interruptTable[10] = 61;    // IPU2-1
 128             }
 129         }
 130         else if (DNUM == 1) {          /* DSP2 */
 131             IntXbar_connect(24, 287);  // eve1 mailbox 1 user 1
 132             IntXbar_connect(25, 296);  // eve2 mailbox 1 user 1
 133             IntXbar_connect(26, 253);  // system mailbox 6 user 0
 134
 135             InterruptDsp_module->interruptTable[7] = 57;    // IPU2-0
 136             InterruptDsp_module->interruptTable[10] = 57;   // IPU2-1
 137
 138             /* plug eve3 and eve4 mbxs only if eve3 and eve4 exists */
 139             if ((MultiProc_getId("EVE3") != MultiProc_INVALIDID) ||
 140                 (MultiProc_getId("EVE4") != MultiProc_INVALIDID)) {
 141                 IntXbar_connect(27, 305);  // eve3 mailbox 1 user 1
 142                 IntXbar_connect(28, 314);  // eve4 mailbox 1 user 1
 143             }
 144
 145             /* plug mbx7 only if DSP1 or IPU1 exists */
 146             if ((MultiProc_getId("DSP1") != MultiProc_INVALIDID) ||
 147                 (MultiProc_getId("IPU1") != MultiProc_INVALIDID) ||
 148                 (MultiProc_getId("IPU1-0") != MultiProc_INVALIDID)) {
 149                 IntXbar_connect(29, 258);  // system mailbox 7 user 1
 150                 InterruptDsp_module->interruptTable[6] = 60;    // IPU1-0
 151             }
 152
 153             /* plug mbx8 only if IPU1-1 exists */
 154             if (MultiProc_getId("IPU1-1") != MultiProc_INVALIDID) {
 155                 IntXbar_connect(30, 262);  // system mailbox 8 user 1
 156                 InterruptDsp_module->interruptTable[9] = 61;    // IPU1-1
 157             }
 158         }
 159         return (Startup_DONE);
 160     }
 161
 162     return (Startup_NOTDONE);
 163 }
 164
 165 /*
 166  *  ======== InterruptDsp_intEnable ========
 167  *  Enable remote processor interrupt
 168  */
 169 Void InterruptDsp_intEnable(UInt16 remoteProcId, IInterrupt_IntInfo *intInfo)
 170 {
 171     UInt16 index;
 172
 173     Assert_isTrue(((remoteProcId < MultiProc_getNumProcsInCluster()) &&
 174             (remoteProcId != MultiProc_self())), ti_sdo_ipc_Ipc_A_internal);
 175
 176     index = MBX_TABLE_IDX(remoteProcId, MultiProc_self());
 177
 178     REG32(MAILBOX_IRQENABLE_SET_DSP(index))=MAILBOX_REG_VAL(SUBMBX_IDX(index));
 179 }
 180
 181 /*
 182  *  ======== InterruptDsp_intDisable ========
 183  *  Disables remote processor interrupt
 184  */
 185 Void InterruptDsp_intDisable(UInt16 remoteProcId, IInterrupt_IntInfo *intInfo)
 186 {
 187     UInt16 index;
 188
 189     Assert_isTrue(((remoteProcId < MultiProc_getNumProcsInCluster()) &&
 190             (remoteProcId != MultiProc_self())), ti_sdo_ipc_Ipc_A_internal);
 191
 192     index = MBX_TABLE_IDX(remoteProcId, MultiProc_self());
 193
 194     REG32(MAILBOX_IRQENABLE_CLR_DSP(index)) = MAILBOX_REG_VAL(SUBMBX_IDX(index));
 195 }
 196
 197 /*
 198  *  ======== InterruptDsp_intRegister ========
 199  */
 200 Void InterruptDsp_intRegister(UInt16 remoteProcId, IInterrupt_IntInfo *intInfo,
 201                               Fxn func, UArg arg)
 202 {
 203     UInt        key;
 204     UInt        eventId;
 205     UInt        combinedEventId;
 206     Int         index;
 207     Hwi_Params  params;
 208     InterruptDsp_FxnTable *table;
 209
 210     Assert_isTrue(((remoteProcId < MultiProc_getNumProcsInCluster()) &&
 211                    (remoteProcId != MultiProc_self())), ti_sdo_ipc_Ipc_A_internal);
 212
 213     index = PROCID(remoteProcId);
 214
 215     /* Disable global interrupts */
 216     key = Hwi_disable();
 217
 218     table = &(InterruptDsp_module->fxnTable[index]);
 219     table->func = func;
 220     table->arg  = arg;
 221
 222     InterruptDsp_intClear(remoteProcId, intInfo);
 223
 224     /* Make sure the interrupt only gets plugged once */
 225     eventId = InterruptDsp_module->interruptTable[index];
 226
 227     InterruptDsp_module->numPlugged++;
 228
 229     if (InterruptDsp_module->numPlugged == 1) {
 230         EventCombiner_dispatchPlug(eventId,
 231             (Hwi_FuncPtr)InterruptDsp_intShmStub, eventId, TRUE);
 232
 233         Hwi_Params_init(&params);
 234         combinedEventId = eventId / EVENT_GROUP_SIZE;
 235         params.eventId = combinedEventId;
 236         params.arg = combinedEventId;
 237         params.enableInt = TRUE;
 238         Hwi_create(intInfo->intVectorId, &ti_sysbios_family_c64p_EventCombiner_dispatch,
 239                    &params, NULL);
 240         Hwi_enableInterrupt(intInfo->intVectorId);
 241     }
 242     else {
 243         EventCombiner_dispatchPlug(eventId,
 244                 (Hwi_FuncPtr)InterruptDsp_intShmStub, eventId, TRUE);
 245     }
 246
 247     /* Enable the mailbox interrupt to the DSP */
 248     InterruptDsp_intEnable(remoteProcId, intInfo);
 249
 250     /* Restore global interrupts */
 251     Hwi_restore(key);
 252 }
 253
 254 /*
 255  *  ======== InterruptDsp_intUnregister ========
 256  */
 257 Void InterruptDsp_intUnregister(UInt16 remoteProcId,
 258                                 IInterrupt_IntInfo *intInfo)
 259 {
 260     Hwi_Handle  hwiHandle;
 261     Int         index;
 262     UInt        eventId;
 263     InterruptDsp_FxnTable *table;
 264
 265     Assert_isTrue(((remoteProcId < MultiProc_getNumProcsInCluster()) &&
 266                    (remoteProcId != MultiProc_self())), ti_sdo_ipc_Ipc_A_internal);
 267
 268     index = PROCID(remoteProcId);
 269
 270     /* Disable the mailbox interrupt source */
 271     InterruptDsp_intDisable(remoteProcId, intInfo);
 272
 273     /* Make sure the interrupt only gets plugged once */
 274     eventId = InterruptDsp_module->interruptTable[index];
 275
 276     InterruptDsp_module->numPlugged--;
 277
 278     EventCombiner_disableEvent(eventId);
 279
 280     if (InterruptDsp_module->numPlugged == 0) {
 281         /* Delete the Hwi */
 282         hwiHandle = Hwi_getHandle(intInfo->intVectorId);
 283         Hwi_delete(&hwiHandle);
 284     }
 285
 286     table = &(InterruptDsp_module->fxnTable[index]);
 287     table->func = NULL;
 288     table->arg  = 0;
 289 }
 290
 291 /*
 292  *  ======== InterruptDsp_intSend ========
 293  *  Send interrupt to the remote processor
 294  */
 295 Void InterruptDsp_intSend(UInt16 remoteProcId, IInterrupt_IntInfo *intInfo,
 296                           UArg arg)
 297 {
 298     UInt key;
 299     UInt16 index;
 300
 301     index = MBX_TABLE_IDX(MultiProc_self(), remoteProcId);
 302
 303     /*
 304      *  Before writing to a mailbox, check whether it already contains a
 305      *  message. If so, wait for the message to be read since we want one
 306      *  and only one message per interrupt. Disable interrupts between reading
 307      *  the MSGSTATUS_X register and writing to the mailbox to protect from
 308      *  another thread doing an intSend at the same time.
 309      */
 310     key = Hwi_disable();
 311     while (REG32(MAILBOX_STATUS(index)) != 0) {
 312         Hwi_restore(key);
 313         key = Hwi_disable();
 314     }
 315     REG32(MAILBOX_MESSAGE(index)) = arg;
 316     Hwi_restore(key);
 317 }
 318
 319 /*
 320  *  ======== InterruptDsp_intPost ========
 321  */
 322 Void InterruptDsp_intPost(UInt16 srcProcId, IInterrupt_IntInfo *intInfo,
 323                           UArg arg)
 324 {
 325     UInt key;
 326     UInt16 index;
 327
 328     index = MBX_TABLE_IDX(srcProcId, MultiProc_self());
 329
 330     key = Hwi_disable();
 331     if (REG32(MAILBOX_STATUS(index)) == 0) {
 332         REG32(MAILBOX_MESSAGE(index)) = arg;
 333     }
 334     Hwi_restore(key);
 335 }
 336
 337 /*
 338  *  ======== InterruptDsp_intClear ========
 339  *  Clear interrupt
 340  */
 341 UInt InterruptDsp_intClear(UInt16 remoteProcId, IInterrupt_IntInfo *intInfo)
 342 {
 343     UInt arg;
 344     UInt16 index;
 345
 346     index = MBX_TABLE_IDX(remoteProcId, MultiProc_self());
 347
 348     arg = REG32(MAILBOX_MESSAGE(index));
 349     REG32(MAILBOX_IRQSTATUS_CLR_DSP(index)) = MAILBOX_REG_VAL(SUBMBX_IDX(index));
 350
 351     /* Write to EOI (End Of Interrupt) register */
 352     REG32(MAILBOX_EOI_REG(index)) = 0x1;
 353
 354     return (arg);
 355 }
 356
 357 /*
 358  *************************************************************************
 359  *                      Internals functions
 360  *************************************************************************
 361  */
 362
 363 /*
 364  *  ======== InterruptDsp_intShmStub ========
 365  */
 366 Void InterruptDsp_intShmStub(UArg arg)
 367 {
 368     UInt16 index;
 369     UInt16 selfIdx;
 370     UInt16 loopIdx;
 371     InterruptDsp_FxnTable *table;
 372
 373     selfIdx = MultiProc_self();
 374
 375     /*
 376      * Loop through each Sub-mailbox to determine which one generated
 377      * interrupt.
 378      */
 379     for (loopIdx = 0; loopIdx < MultiProc_getNumProcsInCluster(); loopIdx++) {
 380
 381         if (loopIdx == selfIdx) {
 382             continue;
 383         }
 384
 385         index = MBX_TABLE_IDX(loopIdx, selfIdx);
 386
 387         if ((REG32(MAILBOX_STATUS(index)) != 0) &&
 388             (REG32(MAILBOX_IRQENABLE_SET_DSP(index)) &
 389              MAILBOX_REG_VAL(SUBMBX_IDX(index)))) {
 390             table = &(InterruptDsp_module->fxnTable[PROCID(loopIdx)]);
 391             (table->func)(table->arg);
 392         }
 393     }
 394 }