linux/src/api/MultiProc.c

   1 /*
   2  * Copyright (c) 2013-2015 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  *  @file       MultiProcQ.c
  34  *
  35  *  @brief      MultiProc Linux implementation
  36  */
  37
  38 /* Standard IPC header */
  39 #include <ti/ipc/Std.h>
  40
  41 /* Module level headers */
  42 #include <ti/ipc/MultiProc.h>
  43 #include <_MultiProc.h>
  44
  45 #include <sys/types.h>
  46 #include <string.h>
  47 #include <stdio.h>
  48 #include <unistd.h>
  49 #include <assert.h>
  50
  51 #include <ladclient.h>
  52 #include <_lad.h>
  53
  54 /* traces in this file are controlled via _MultiProc_verbose */
  55 Bool _MultiProc_verbose = FALSE;
  56 #define verbose _MultiProc_verbose
  57
  58 /* =============================================================================
  59  * APIS
  60  * =============================================================================
  61  */
  62 /* Function to get default configuration for the MultiProc module.
  63  *
  64  */
  65 Void MultiProc_getConfig (MultiProc_Config * cfg)
  66 {
  67     Int status;
  68     LAD_ClientHandle handle;
  69     struct LAD_CommandObj cmd;
  70     union LAD_ResponseObj rsp;
  71
  72     assert (cfg != NULL);
  73
  74     handle = LAD_findHandle();
  75
  76     if (handle == LAD_MAXNUMCLIENTS) {
  77         PRINTVERBOSE1("MultiProc_getConfig: can't find connection to daemon "
  78                 "for pid %d\n", getpid())
  79         return;
  80     }
  81
  82     cmd.cmd = LAD_MULTIPROC_GETCONFIG;
  83     cmd.clientId = handle;
  84
  85     if ((status = LAD_putCommand(&cmd)) != LAD_SUCCESS) {
  86         PRINTVERBOSE1("MultiProc_getConfig: sending LAD command failed, "
  87                 "status=%d\n", status)
  88         return;
  89     }
  90
  91     if ((status = LAD_getResponse(handle, &rsp)) != LAD_SUCCESS) {
  92         PRINTVERBOSE1("MultiProc_getConfig: no LAD response, status=%d\n",
  93                 status)
  94         return;
  95     }
  96     status = rsp.multiprocGetConfig.status;
  97
  98     PRINTVERBOSE2("MultiProc_getConfig: got LAD response for client %d, "
  99             "status=%d\n", handle, status)
 100
 101     memcpy(cfg, &rsp.multiprocGetConfig.cfg, sizeof(*cfg));
 102
 103     return;
 104 }
 105
 106 /*
 107  *  ======== MultiProc_rprocSetId ========
 108  */
 109 Int MultiProc_rprocSetId(UInt16 procId, UInt rprocId)
 110 {
 111     Int status;
 112     LAD_ClientHandle handle;
 113     struct LAD_CommandObj cmd;
 114     union LAD_ResponseObj rsp;
 115     UInt16 clusterId;
 116
 117
 118     handle = LAD_findHandle();
 119
 120     if (handle == LAD_MAXNUMCLIENTS) {
 121         PRINTVERBOSE1("MultiProc_rprocSetId: can't find connection to daemon "
 122                 "for pid %d\n", getpid())
 123         return (-1);
 124     }
 125
 126     cmd.cmd = LAD_RPROC_SETID;
 127     cmd.clientId = handle;
 128     cmd.args.rprocSetId.procId = procId;
 129     cmd.args.rprocSetId.rprocId = rprocId;
 130
 131     if ((status = LAD_putCommand(&cmd)) != LAD_SUCCESS) {
 132         PRINTVERBOSE1("MultiProc_rprocSetId: sending LAD command failed, "
 133                 "status=%d\n", status)
 134         return (status);
 135     }
 136
 137     if ((status = LAD_getResponse(handle, &rsp)) != LAD_SUCCESS) {
 138         PRINTVERBOSE1("MultiProc_rprocSetId: no LAD response, status=%d\n",
 139                 status)
 140         return (status);
 141     }
 142     status = rsp.status;
 143
 144     PRINTVERBOSE2("MultiProc_rprocSetId: got LAD response for client %d, "
 145             "status=%d\n", handle, status)
 146
 147     /* update configuration in api state */
 148     clusterId = procId - _MultiProc_cfg.baseIdOfCluster;
 149     _MultiProc_cfg.rprocList[clusterId] = rprocId;
 150
 151     return (status);
 152 }