Add support for IPC_DEBUG in QNX
[ipc/ipcdev.git] / qnx / src / api / gates / GateHWSpinlock.c
1 /*
2  * Copyright (c) 2013-2015, 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  *  ======== GateHWSpinlock.c ========
35  */
37 /* Standard headers */
38 #include <ti/ipc/Std.h>
40 /* Utilities & OSAL headers */
41 #include <ti/ipc/MultiProc.h>
42 #include <ti/ipc/GateMP.h>
44 #include <ti/syslink/inc/GateHWSpinlock.h>
46 #include <ti/syslink/utils/IGateProvider.h>
48 /*
49  * TODO: does this belong in ti/ipc/Std.h? We should consider getting rid of
50  *       error blocks from the GateMutex.h interface.
51  */
52 typedef UInt32            Error_Block;
53 #include <ti/syslink/utils/GateMutex.h>
55 /* Module level headers */
56 #include <ti/syslink/utils/String.h>
58 #include <_IpcLog.h>
60 #include <assert.h>
61 #include <string.h>
62 #include <stdlib.h>
63 #include <sys/mman.h>
65 /*
66  * TODO: Hardcoding these for now. In daemon, we should ideally pass these in
67  * through config in GateHWSpinlock_setup and user lib can query the daemon.
68  */
69 #define HWSPINLOCK_BASE             0x4A0F6000
70 #define HWSPINLOCK_SIZE             0x1000
71 #define HWSPINLOCK_OFFSET           0x800
74 /* =============================================================================
75  * Structures & Enums
76  * =============================================================================
77  */
78 /* GateHWSpinlock Module Local State */
79 typedef struct {
80     UInt32 *                        baseAddr;   /* base addr lock registers */
81     GateMutex_Handle                gmHandle;   /* handle to gate mutex */
82 } GateHWSpinlock_Module_State;
84 /* GateHWSpinlock instance object */
85 struct GateHWSpinlock_Object {
86     IGateProvider_SuperObject; /* For inheritance from IGateProvider */
87     UInt                        lockNum;
88     UInt                        nested;
89     IGateProvider_Handle        localGate;
90     int                         token;  /* HWSpinlock token */
91 };
94 /* =============================================================================
95  * Globals
96  * =============================================================================
97  */
98 static GateHWSpinlock_Module_State GateHWSpinlock_state =
99 {
100     .baseAddr = NULL,
101     .gmHandle = NULL
102 };
104 static GateHWSpinlock_Module_State *Mod = &GateHWSpinlock_state;
106 static GateHWSpinlock_Params GateHWSpinlock_defInstParams =
108     .resourceId = 0,
109     .openFlag   = FALSE,
110     .regionId   = 0,
111     .sharedAddr = NULL
112 };
114 /* traces in this file are controlled via _GateHWSpinlock_verbose */
115 Bool _GateHWSpinlock_verbose = FALSE;
116 #define verbose _GateHWSpinlock_verbose
118 /* =============================================================================
119  * APIS
120  * =============================================================================
121  */
122 /*
123  *  Function to start the GateHWSpinlock module.
124  */
125 Int32 GateHWSpinlock_start(Void)
127     Int32               status = GateHWSpinlock_S_SUCCESS;
128     UInt32              dst;
130     /* map the hardware lock registers into the local address space */
131     if (status == GateHWSpinlock_S_SUCCESS) {
132         dst = (UInt32)mmap(NULL, HWSPINLOCK_SIZE,
133                             (PROT_READ | PROT_WRITE | PROT_NOCACHE),
134                             (MAP_PHYS|MAP_SHARED), NOFD,
135                             (off_t)HWSPINLOCK_BASE);
137         if (dst == (UInt32)MAP_FAILED) {
138             PRINTVERBOSE0("GateHWSpinlock_start: Memory map failed")
139             status = GateHWSpinlock_E_OSFAILURE;
140         }
141         else {
142             Mod->baseAddr = (UInt32 *)(dst + HWSPINLOCK_OFFSET);
143             status = GateHWSpinlock_S_SUCCESS;
144         }
145     }
147     /* create GateMutex for local protection*/
148     if (status == GateHWSpinlock_S_SUCCESS) {
149         Mod->gmHandle = GateMutex_create(NULL, NULL);
151         if (Mod->gmHandle == NULL) {
152             PRINTVERBOSE0("GateHWSpinlock_start: GateMutex create failed")
153             status = GateHWSpinlock_E_FAIL;
154             GateHWSpinlock_stop();
155         }
156     }
158     return (status);
161 /*
162  *  Function to stop the GateHWSpinlock module.
163  */
164 Int GateHWSpinlock_stop(Void)
166     Int32               status = GateHWSpinlock_S_SUCCESS;
168     /* delete GateMutex */
169     if (Mod->gmHandle != NULL) {
170         status = GateMutex_delete(&Mod->gmHandle);
171     }
173     /* release lock register mapping */
174     if (Mod->baseAddr != NULL) {
175         munmap((void *)HWSPINLOCK_BASE, HWSPINLOCK_SIZE);
176     }
178     return(status);
181 /*
182  *  Initialize parameter structure
183  */
184 Void GateHWSpinlock_Params_init(GateHWSpinlock_Params *params)
186     assert(params != NULL);
188     memcpy(params, &GateHWSpinlock_defInstParams,
189         sizeof(GateHWSpinlock_Params));
192 /*
193  * Create a GateHWSpinlock instance
194  */
195 /* TODO: change the function to accept a local gate. Do this on all platforms */
196 GateHWSpinlock_Handle GateHWSpinlock_create(GateHWSpinlock_LocalProtect
197     localProtect, const GateHWSpinlock_Params * params)
199     GateHWSpinlock_Object * obj = (GateHWSpinlock_Object *)calloc(1,
200         sizeof (GateHWSpinlock_Object));
202     if (!obj) {
203         PRINTVERBOSE0("GateHWSpinlock_create: memory allocation failure")
204         return NULL;
205     }
207     IGateProvider_ObjectInitializer(obj, GateHWSpinlock);
208     /* TODO: handle more local protection types */
209     obj->localGate = (IGateProvider_Handle)Mod->gmHandle;
210     obj->lockNum = params->resourceId;
211     obj->nested = 0;
213     return (GateHWSpinlock_Handle)obj;
216 /*
217  * Delete a GateHWSpinlock instance
218  */
219 Int GateHWSpinlock_delete (GateHWSpinlock_Handle * handle)
221     GateHWSpinlock_Object * obj;
222     Int  status = GateHWSpinlock_S_SUCCESS;
224     if (handle == NULL) {
225         return GateHWSpinlock_E_INVALIDARG;
226     }
227     if (*handle == NULL) {
228         return GateHWSpinlock_E_INVALIDARG;
229     }
231     obj = (GateHWSpinlock_Object *)(*handle);
233     free(obj);
234     *handle = NULL;
236     return (status);
239 /*
240  *  Enter a GateHWSpinlock instance
241  */
242 IArg GateHWSpinlock_enter(GateHWSpinlock_Object *obj)
244     volatile UInt32 *baseAddr = Mod->baseAddr;
245     IArg key;
247     key = IGateProvider_enter(obj->localGate);
249     /* if gate already entered, just return with current key */
250     obj->nested++;
251     if (obj->nested > 1) {
252         return(key);
253     }
255     /* enter the spinlock */
256     while (1) {
257         /* read the spinlock, returns non-zero when we get it */
258         if (baseAddr[obj->lockNum] == 0) {
259             break;
260         }
261         obj->nested--;
262         IGateProvider_leave(obj->localGate, key);
263         key = IGateProvider_enter(obj->localGate);
264         obj->nested++; /* re-nest the gate */
265     }
267     return (key);
270 /*
271  *  Leave a GateHWSpinlock instance
272  */
273 Int GateHWSpinlock_leave(GateHWSpinlock_Object *obj, IArg key)
275     volatile UInt32 *baseAddr = Mod->baseAddr;
277     obj->nested--;
279     /* release the spinlock if not nested */
280     if (obj->nested == 0) {
281         baseAddr[obj->lockNum] = 0;
282     }
284     IGateProvider_leave(obj->localGate, key);
286     return GateHWSpinlock_S_SUCCESS;