blob: 00a1872f667ecc76dd46178b580e98a32287c4a3 [file] [log] [blame]
Dima Zavina404bce2009-01-26 12:32:22 -08001/*
2 * Copyright (c) 2009, Google Inc.
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 * * Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * * Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in
12 * the documentation and/or other materials provided with the
13 * distribution.
14 *
15 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
16 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
17 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
18 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
19 * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
21 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
22 * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
23 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
24 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
25 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 */
28
29#include <debug.h>
30#include <reg.h>
31#include <sys/types.h>
32#include <platform/iomap.h>
33
34#include "smem.h"
35
36static struct smem *smem = (void *)(MSM_SHARED_BASE);
37
Ajay Dudanic78b36f2010-07-08 19:34:06 -070038/* buf MUST be 4byte aligned, and len MUST be a multiple of 8. */
Dima Zavina404bce2009-01-26 12:32:22 -080039unsigned smem_read_alloc_entry(smem_mem_type_t type, void *buf, int len)
40{
41 struct smem_alloc_info *ainfo;
42 unsigned *dest = buf;
43 unsigned src;
44 unsigned size;
45
46 if (((len & 0x3) != 0) || (((unsigned)buf & 0x3) != 0))
47 return 1;
48
49 if (type < SMEM_FIRST_VALID_TYPE || type > SMEM_LAST_VALID_TYPE)
50 return 1;
51
52 /* TODO: Use smem spinlocks */
53 ainfo = &smem->alloc_info[type];
54 if (readl(&ainfo->allocated) == 0)
55 return 1;
56
Ajay Dudanic78b36f2010-07-08 19:34:06 -070057 size = readl(&ainfo->size);
58
59 if (size != (unsigned)((len + 7) & ~0x00000007))
Dima Zavina404bce2009-01-26 12:32:22 -080060 return 1;
61
62 src = MSM_SHARED_BASE + readl(&ainfo->offset);
Ajay Dudanic78b36f2010-07-08 19:34:06 -070063 for (; len > 0; src += 4, len -= 4)
Dima Zavina404bce2009-01-26 12:32:22 -080064 *(dest++) = readl(src);
65
66 return 0;
67}
Chandan Uddaraju1434a602010-03-08 17:13:38 -080068
Ajay Dudanib01e5062011-12-03 23:23:42 -080069unsigned
70smem_read_alloc_entry_offset(smem_mem_type_t type, void *buf, int len,
71 int offset)
Chandan Uddaraju1434a602010-03-08 17:13:38 -080072{
Ajay Dudanib01e5062011-12-03 23:23:42 -080073 struct smem_alloc_info *ainfo;
74 unsigned *dest = buf;
75 unsigned src;
76 unsigned size = len;
Chandan Uddaraju1434a602010-03-08 17:13:38 -080077
Ajay Dudanib01e5062011-12-03 23:23:42 -080078 if (((len & 0x3) != 0) || (((unsigned)buf & 0x3) != 0))
79 return 1;
Chandan Uddaraju1434a602010-03-08 17:13:38 -080080
Ajay Dudanib01e5062011-12-03 23:23:42 -080081 if (type < SMEM_FIRST_VALID_TYPE || type > SMEM_LAST_VALID_TYPE)
82 return 1;
Chandan Uddaraju1434a602010-03-08 17:13:38 -080083
Ajay Dudanib01e5062011-12-03 23:23:42 -080084 ainfo = &smem->alloc_info[type];
85 if (readl(&ainfo->allocated) == 0)
86 return 1;
Chandan Uddaraju1434a602010-03-08 17:13:38 -080087
Ajay Dudanib01e5062011-12-03 23:23:42 -080088 src = MSM_SHARED_BASE + readl(&ainfo->offset) + offset;
89 for (; size > 0; src += 4, size -= 4)
90 *(dest++) = readl(src);
Chandan Uddaraju1434a602010-03-08 17:13:38 -080091
Ajay Dudanib01e5062011-12-03 23:23:42 -080092 return 0;
Chandan Uddaraju1434a602010-03-08 17:13:38 -080093}