Initial
[ivimm/rvc.git] / appA15HeartBeatHost.c
1 /*
2  * Copyright (c) 2016, 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  */
33 /*
34  *  ======== appA15HeartBeatHost.c ========
35  *
36  */
38 /* host header files */
39 #include <stdio.h>
40 #include <unistd.h>
41 #include <time.h>
43 /* package header files */
44 #include <ti/ipc/Std.h>
45 #include <ti/ipc/Ipc.h>
46 #include <ti/ipc/transports/TransportRpmsg.h>
47 #include <ti/ipc/MessageQ.h>
48 #include <ti/ipc/MultiProc.h>
50 /* private functions */
51 static Int Main_main(Void);
52 static Int Main_parseArgs(Int argc, Char *argv[]);
54 /* local header files */
55 #include "appA15HeartBeatHost.h"
57 /* module structure */
58 typedef struct {
59     MessageQ_MsgHeader  reserved;
60     UInt32              cmd;
61 } App_Msg;
63 typedef struct {
64     MessageQ_Handle         hostQue;    // created locally
65     MessageQ_QueueId        slaveQue;   // opened remotely
66     UInt16                  heapId;     // MessageQ heapId
67     UInt32                  msgSize;
68 } App_Module;
70 /* private data */
71 static App_Module Module;
72 static String   Main_remoteProcName = NULL;
73 #ifdef DEBUG
74 static UInt32 MessageCount = 0;
75 #endif
76 /*
77  *  ======== App_create ========
78  */
80 Int App_create(UInt16 remoteProcId)
81 {
82     Int                 status = 0;
83     MessageQ_Params     msgqParams;
84     char                msgqName[32];
86     ALOGE("--> App_create:");
88     /* setting default values */
89     Module.hostQue = NULL;
90     Module.slaveQue = MessageQ_INVALIDMESSAGEQ;
91     Module.heapId = App_MsgHeapId;
92     Module.msgSize = sizeof(App_Msg);
94     /* create local message queue (inbound messages) */
95     MessageQ_Params_init(&msgqParams);
97     Module.hostQue = MessageQ_create(App_HostMsgQueName, &msgqParams);
99     if (Module.hostQue == NULL) {
100         ALOGE("App_create: Failed creating MessageQ");
101         status = -1;
102         goto leave;
103     }
105     /* open the remote message queue */
106     sprintf(msgqName, App_SlaveMsgQueName, MultiProc_getName(remoteProcId));
108     do {
109         status = MessageQ_open(msgqName, &Module.slaveQue);
110         sleep(1);
111     } while (status == MessageQ_E_NOTFOUND);
113     if (status < 0) {
114         ALOGE("App_create: Failed opening MessageQ");
115         goto leave;
116     }
118     ALOGE("App_create: Host is ready");
120 leave:
121     ALOGE("<-- App_create:");
122     return(status);
126 /*
127  *  ======== App_delete ========
128  */
129 Int App_delete(Void)
131     Int         status;
133     ALOGE("--> App_delete:");
135     /* close remote resources */
136     status = MessageQ_close(&Module.slaveQue);
138     if (status < 0) {
139         goto leave;
140     }
142     /* delete the host message queue */
143     status = MessageQ_delete(&Module.hostQue);
145     if (status < 0) {
146         goto leave;
147     }
149 leave:
150     ALOGE("<-- App_delete:");
151     return(status);
155 /*
156  *  ======== App_exec ========
157  */
158 Int App_exec(Void)
160     Int         status;
161     Int         i;
162     App_Msg *   msg;
163     Bool        running = TRUE;
164     struct timeval tv;
166     ALOGE("--> App_exec:");
168     /* allocate message */
169     msg = (App_Msg *)MessageQ_alloc(Module.heapId, Module.msgSize);
171     if (msg == NULL) {
172         status = -1;
173         goto leave;
174     }
176     /* fill in message payload */
177     msg->cmd = App_CMD_START;
178 #ifdef DEBUG
179     MessageCount++;
180     // Get current time of day
181     gettimeofday(&tv, NULL);
182     ALOGE("%ld us: App_exec: sending #%d message %d \n", (tv.tv_sec * 1000000) + tv.tv_usec, MessageCount, msg->cmd);
183 #endif
185     while (running) {
186         /* send START 1st message */
187         MessageQ_put(Module.slaveQue, (MessageQ_Msg)msg);
189         // Sleep for Microseconds - 500ms
190         usleep(Microseconds);
192         /* allocate message */
193         msg = (App_Msg *)MessageQ_alloc(Module.heapId, Module.msgSize);
195         if (msg == NULL) {
196             ALOGE("--> App_exec: MessageQ_alloc FAILED");
197             status = -1;
198             goto leave;
199         }
201         /* fill in message payload */
202         msg->cmd = App_CMD_ALIVE;
203 #ifdef DEBUG
204         MessageCount++;
205         gettimeofday(&tv, NULL);
206         ALOGE("%ld us: App_exec: sending #%d App_CMD_ALIVE \n", (tv.tv_sec * 1000000) + tv.tv_usec, MessageCount);
207 #endif
208     }
210 leave:
211     ALOGE("<-- App_exec: %d\n", status);
212     return(status);
215 /*
216  *  ======== main ========
217  */
218 Int main(Int argc, Char* argv[])
220     Int status;
222     ALOGE("--> main:");
224     /* configure the transport factory */
225     Ipc_transportConfig(&TransportRpmsg_Factory);
227     /* parse command line */
228     status = Main_parseArgs(argc, argv);
230     if (status < 0) {
231         goto leave;
232     }
234     /* Ipc initialization */
235     status = Ipc_start();
237     if (status >= 0) {
238         /* application create, exec, delete */
239         status = Main_main();
241         /* Ipc finalization */
242         Ipc_stop();
243     }
244     else {
245         ALOGE("Ipc_start failed: status = %d\n", status);
246         goto leave;
247     }
249 leave:
250     ALOGE("<-- main:\n");
251     status = (status >= 0 ? 0 : status);
253     return (status);
257 /*
258  *  ======== Main_main ========
259  */
260 Int Main_main(Void)
262     UInt16      remoteProcId;
263     Int         status = 0;
265     ALOGE("--> Main_main:\n");
267     remoteProcId = MultiProc_getId(Main_remoteProcName);
269     /* application create phase */
270     status = App_create(remoteProcId);
272     if (status < 0) {
273         goto leave;
274     }
276     /* application execute phase */
277     status = App_exec();
279     if (status < 0) {
280         goto leave;
281     }
283     /* application delete phase */
284     status = App_delete();
286     if (status < 0) {
287         goto leave;
288     }
290 leave:
291     ALOGE("<-- Main_main:");
293     status = (status >= 0 ? 0 : status);
294     return (status);
298 /*
299  *  ======== Main_parseArgs ========
300  */
301 Int Main_parseArgs(Int argc, Char *argv[])
303     Int             x, cp, opt, argNum;
304     UInt16          i, numProcs;
305     String          name;
306     Int             status = 0;
309     /* parse the command line options */
310     for (opt = 1; (opt < argc) && (argv[opt][0] == '-'); opt++) {
311         for (x = 0, cp = 1; argv[opt][cp] != '\0'; cp++) {
312             x = (x << 8) | (int)argv[opt][cp];
313         }
315         switch (x) {
316             case 'h': /* -h */
317                 ALOGE("%s", Main_USAGE);
318                 exit(0);
319                 break;
321             case 'l': /* -l */
322                 //ALOGE("Processor List");
323                 printf("Processor List\n");
324                 status = Ipc_start();
325                 if (status >= 0) {
326                     numProcs = MultiProc_getNumProcessors();
327                     for (i = 0; i < numProcs; i++) {
328                         name = MultiProc_getName(i);
329                         //ALOGE("    procId=%d, procName=%s", i, name);
330                         printf("    procId=%d, procName=%s\n", i, name);
331                     }
332                     Ipc_stop();
333                 }
334                 else {
335                     printf(
336                         "Error: %s, line %d: Ipc_start failed status %d\n",
337                         __FILE__, __LINE__, status);
338                     goto leave;
339                 }
340                 exit(0);
341                 break;
343             default:
344                 printf(
345                     "Error: %s, line %d: invalid option, %c\n",
346                     __FILE__, __LINE__, (Char)x);
347                 printf("%s", Main_USAGE);
348                 status = -1;
349                 goto leave;
350         }
351     }
353     /* parse the command line arguments */
354     for (argNum = 1; opt < argc; argNum++, opt++) {
356         switch (argNum) {
357             case 1: /* name of proc #1 */
358                 Main_remoteProcName = argv[opt];
359                 break;
361             default:
362                 printf(
363                     "Error: %s, line %d: too many arguments\n",
364                     __FILE__, __LINE__);
365                 printf("%s", Main_USAGE);
366                 status = -1;
367                 goto leave;
368         }
369     }
371     /* validate command line arguments */
372     if (Main_remoteProcName == NULL) {
373         printf("Error: missing procName argument\n");
374         printf("%s", Main_USAGE);
375         status = -1;
376         goto leave;
377     }
379 leave:
380     return(status);