109 lines
3.6 KiB
C
109 lines
3.6 KiB
C
|
/* Copyright (c) 2012, The Linux Foundation. All rights reserved.
|
||
|
|
*
|
||
|
|
* Redistribution and use in source and binary forms, with or without
|
||
|
|
* modification, are permitted provided that the following conditions are
|
||
|
|
* met:
|
||
|
|
* * Redistributions of source code must retain the above copyright
|
||
|
|
* notice, this list of conditions and the following disclaimer.
|
||
|
|
* * Redistributions in binary form must reproduce the above
|
||
|
|
* copyright notice, this list of conditions and the following
|
||
|
|
* disclaimer in the documentation and/or other materials provided
|
||
|
|
* with the distribution.
|
||
|
|
* * Neither the name of The Linux Foundation nor the names of its
|
||
|
|
* contributors may be used to endorse or promote products derived
|
||
|
|
* from this software without specific prior written permission.
|
||
|
|
*
|
||
|
|
* THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
|
||
|
|
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
||
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
|
||
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
|
||
|
|
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
|
||
|
|
* BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
|
||
|
|
* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
|
||
|
|
* OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
|
||
|
|
* IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||
|
|
*
|
||
|
|
*/
|
||
|
|
#include <platform/iomap.h>
|
||
|
|
#include <platform/remote_spinlock.h>
|
||
|
|
#include <debug.h>
|
||
|
|
#include <smem.h>
|
||
|
|
#include <reg.h>
|
||
|
|
|
||
|
|
static struct smem *smem = (void *)(MSM_SHARED_BASE);
|
||
|
|
|
||
|
|
void *smem_rlock_get_entry(unsigned id, unsigned *size)
|
||
|
|
{
|
||
|
|
struct smem_alloc_info *ainfo;
|
||
|
|
void *ret = 0;
|
||
|
|
unsigned long flags = 0;
|
||
|
|
|
||
|
|
ainfo = &smem->alloc_info[id];
|
||
|
|
|
||
|
|
if (readl(&ainfo->allocated) == 0) {
|
||
|
|
dprintf(SPEW,"Shared memory is not allocated\n");
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
/* Read the DAL area */
|
||
|
|
*size = readl(&ainfo->size);
|
||
|
|
ret = (void *) (MSM_SHARED_BASE + readl(&ainfo->offset));
|
||
|
|
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
int remote_spinlock_init(remote_spinlock_t *lock)
|
||
|
|
{
|
||
|
|
struct rlock_chunk_header *cur_header;
|
||
|
|
void *rlock_smem_start, *rlock_smem_end;
|
||
|
|
uint32_t rlock_smem_size = 0;
|
||
|
|
int smem_status = 0;
|
||
|
|
|
||
|
|
rlock_smem_start = smem_rlock_get_entry(SMEM_RLOCK_AREA, &rlock_smem_size);
|
||
|
|
|
||
|
|
if (!rlock_smem_start) {
|
||
|
|
dprintf(CRITICAL,"Failed to get smem entry for remote spin lock\n");
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
rlock_smem_end = rlock_smem_start + rlock_smem_size;
|
||
|
|
|
||
|
|
cur_header = (struct rlock_chunk_header *)
|
||
|
|
(((uint32_t)rlock_smem_start + (4095)) & ~4095);
|
||
|
|
*lock = NULL;
|
||
|
|
/* Find the lock from the list */
|
||
|
|
while (cur_header->size != 0
|
||
|
|
&& ((uint32_t)(cur_header + 1) < (uint32_t)rlock_smem_end)) {
|
||
|
|
/* If we found the lock, get the address */
|
||
|
|
if (!strncmp(cur_header->name, RLOCK_CHUNK_NAME,
|
||
|
|
RLOCK_CHUNK_NAME_LENGTH)) {
|
||
|
|
*lock = (remote_spinlock_t)&cur_header->lock;
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
cur_header = (void *)cur_header + cur_header->size;
|
||
|
|
}
|
||
|
|
dprintf(CRITICAL,"%s: remote lock not found: %s\n",RLOCK_CHUNK_NAME,__FILE__);
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
void remote_spin_lock(raw_remote_spinlock_t *lock)
|
||
|
|
{
|
||
|
|
lock->dek.self_lock = DEK_LOCK_REQUEST;
|
||
|
|
|
||
|
|
/* check if the lock is available*/
|
||
|
|
while(lock->dek.other_lock) {
|
||
|
|
if(lock->dek.next_yield == DEK_YIELD_TURN_SELF)
|
||
|
|
while (lock->dek.other_lock);
|
||
|
|
lock->dek.self_lock = DEK_LOCK_REQUEST;
|
||
|
|
}
|
||
|
|
/* We acquired the lock */
|
||
|
|
lock->dek.next_yield = DEK_YIELD_TURN_SELF;
|
||
|
|
dmb();
|
||
|
|
}
|
||
|
|
void remote_spin_unlock(raw_remote_spinlock_t *lock)
|
||
|
|
{
|
||
|
|
dmb();
|
||
|
|
lock->dek.self_lock = DEK_LOCK_YIELD;
|
||
|
|
}
|