qnx/src/api/Ipc.c

   1 /*
   2  * Copyright (c) 2013, 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  *  @file       Ipc.c
  34  *
  35  *  @brief      Starts and stops user side Ipc
  36  *              All setup/destroy APIs on user side will be call from this
  37  *              module.
  38  *
  39  *  @ver        0002
  40  *
  41  */
  42
  43 /* Standard headers */
  44 #include <stdio.h>
  45 #include <stdlib.h>
  46 #include <signal.h>
  47 #include <ti/ipc/Std.h>
  48
  49 /* Common IPC headers: */
  50 #include <ti/ipc/Ipc.h>
  51 #include <ti/ipc/NameServer.h>
  52
  53 /* User side headers */
  54 #include <ti/syslink/inc/usr/Qnx/IpcDrv.h>
  55
  56 /* IPC startup/shutdown stuff: */
  57 #include <ti/ipc/MultiProc.h>
  58 #include <ti/ipc/MessageQ.h>
  59 #include <ti/ipc/NameServer.h>
  60 #include <_MessageQ.h>
  61 #include <_NameServer.h>
  62 #include <_GateMP.h>
  63 #include <_GateMP_usr.h>
  64 #include <ti/syslink/inc/GateHWSpinlock.h>
  65 #include <ti/syslink/inc/_MultiProc.h>
  66
  67 MultiProc_Config _MultiProc_cfg;
  68
  69 static void cleanup(int arg);
  70
  71 /** ============================================================================
  72  *  Functions
  73  *  ============================================================================
  74  */
  75 /* Function to start Ipc */
  76 Int Ipc_start (Void)
  77 {
  78     MessageQ_Config   msgqCfg;
  79     MultiProc_Config  mpCfg;
  80     Int32             status = Ipc_S_SUCCESS;
  81     UInt16            rprocId;
  82
  83     /* Catch ctrl-C, and cleanup: */
  84     (void) signal(SIGINT, cleanup);
  85
  86     status = IpcDrv_open();
  87     if (status < 0) {
  88         printf("Ipc_start: IpcDrv_open() failed: %d\n", status);
  89         status = Ipc_E_FAIL;
  90         goto exit;
  91     }
  92
  93     status = NameServer_setup();
  94     if (status >= 0) {
  95         MessageQ_getConfig(&msgqCfg);
  96         MessageQ_setup(&msgqCfg);
  97
  98         /* Setup and get MultiProc configuration from resource manager */
  99         MultiProc_getConfig(&mpCfg);
 100         _MultiProc_cfg = mpCfg;
 101
 102         /* Now attach to all remote processors, assuming they are up. */
 103         for (rprocId = 0;
 104              (rprocId < MultiProc_getNumProcessors()) && (status >= 0);
 105              rprocId++) {
 106            if (0 == rprocId) {
 107                /* Skip host, which should always be 0th entry. */
 108                continue;
 109            }
 110            status = MessageQ_attach (rprocId, NULL);
 111            if (status < 0) {
 112               printf("Ipc_start: MessageQ_attach(%d) failed: %d\n",
 113                      rprocId, status);
 114               status = Ipc_E_FAIL;
 115               goto messageqattach_fail;
 116            }
 117         }
 118     }
 119     else {
 120         printf("Ipc_start: NameServer_setup() failed: %d\n", status);
 121         status = Ipc_E_FAIL;
 122         goto nameserversetup_fail;
 123     }
 124
 125     /* Start GateMP only if it is setup in the resource manager */
 126 #if defined(GATEMP_SUPPORT)
 127     if (GateMP_isSetup()) {
 128         status = GateHWSpinlock_start();
 129         if (status < 0) {
 130             printf("Ipc_start: GateHWSpinlock_start failed: %d\n",
 131                 status);
 132             status = Ipc_E_FAIL;
 133             goto gatehwspinlockstart_fail;
 134         }
 135         else {
 136             status = GateMP_start();
 137             if (status < 0) {
 138                 printf("Ipc_start: GateMP_start failed: %d\n",
 139                 status);
 140                 status = Ipc_E_FAIL;
 141                 goto gatempstart_fail;
 142             }
 143         }
 144     }
 145 #endif
 146     /* Success */
 147     goto exit;
 148 #if defined(GATEMP_SUPPORT)
 149 gatempstart_fail:
 150     GateHWSpinlock_stop();
 151 gatehwspinlockstart_fail:
 152     for (rprocId = rprocId - 1; (rprocId > 0) && (status >= 0); rprocId--) {
 153        MessageQ_detach(rprocId);
 154     }
 155 #endif
 156 messageqattach_fail:
 157     MessageQ_destroy();
 158     NameServer_destroy();
 159 nameserversetup_fail:
 160     IpcDrv_close();
 161
 162 exit:
 163     return (status);
 164 }
 165
 166
 167 /* Function to stop Ipc */
 168 Int Ipc_stop (Void)
 169 {
 170     Int32             status = Ipc_S_SUCCESS;
 171     UInt16            rprocId;
 172 #if defined(GATEMP_SUPPORT)
 173     if (GateMP_isSetup()) {
 174         /* Stop GateMP */
 175         status = GateMP_stop();
 176         if (status < 0) {
 177             printf("Ipc_stop: GateMP_stop() failed: %d\n", status);
 178             status = Ipc_E_FAIL;
 179             goto exit;
 180         }
 181
 182         /* Finalize GateHWSpinlock */
 183         status = GateHWSpinlock_stop();
 184         if (status < 0) {
 185             printf("Ipc_stop: GateHWSpinlock_stop() failed: %d\n", status);
 186             status = Ipc_E_FAIL;
 187             goto exit;
 188         }
 189     }
 190 #endif
 191     /* Now detach from all remote processors, assuming they are up. */
 192     for (rprocId = 0;
 193          (rprocId < MultiProc_getNumProcessors()) && (status >= 0);
 194          rprocId++) {
 195        if (0 == rprocId) {
 196           /* Skip host, which should always be 0th entry. */
 197           continue;
 198        }
 199        status = MessageQ_detach(rprocId);
 200        if (status < 0) {
 201             printf("Ipc_stop: MessageQ_detach(%d) failed: %d\n",
 202                  rprocId, status);
 203             status = Ipc_E_FAIL;
 204             goto exit;
 205        }
 206     }
 207
 208     status = MessageQ_destroy();
 209     if (status < 0) {
 210         printf("Ipc_stop: MessageQ_destroy() failed: %d\n", status);
 211         status = Ipc_E_FAIL;
 212         goto exit;
 213     }
 214
 215     status = NameServer_destroy();
 216     if (status < 0) {
 217         printf("Ipc_stop: NameServer_destroy() failed: %d\n", status);
 218         status = Ipc_E_FAIL;
 219         goto exit;
 220     }
 221
 222     IpcDrv_close();
 223
 224 exit:
 225     return (status);
 226 }
 227
 228 static void cleanup(int arg)
 229 {
 230     printf("Ipc: Caught SIGINT, calling Ipc_stop...\n");
 231     Ipc_stop();
 232     exit(0);
 233 }