1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
|
/*
* Support for Medifield PNW Camera Imaging ISP subsystem.
*
* Copyright (c) 2010 Intel Corporation. All Rights Reserved.
*
* Copyright (c) 2010 Silicon Hive www.siliconhive.com.
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License version
* 2 as published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
* 02110-1301, USA.
*
*/
#include "atomisp_internal.h"
#include "hive_isp_css_mm_hrt.h"
#include "hmm/hmm.h"
#define __page_align(size) (((size) + (PAGE_SIZE-1)) & (~(PAGE_SIZE-1)))
static unsigned init_done;
void hrt_isp_css_mm_init(void)
{
hmm_init();
init_done = 1;
}
int hrt_isp_css_mm_set(ia_css_ptr virt_addr, int c, size_t bytes)
{
if (virt_addr)
return hmm_set(virt_addr, c, bytes);
return -EFAULT;
}
int hrt_isp_css_mm_load(ia_css_ptr virt_addr, void *data, size_t bytes)
{
if (virt_addr && data)
return hmm_load(virt_addr, data, bytes);
return -EFAULT;
}
int hrt_isp_css_mm_store(ia_css_ptr virt_addr, const void *data, size_t bytes)
{
if (virt_addr && data)
return hmm_store(virt_addr, data, bytes);
return -EFAULT;
}
void hrt_isp_css_mm_free(ia_css_ptr virt_addr)
{
if (virt_addr)
hmm_free(virt_addr);
}
void hrt_isp_css_mm_clear(void)
{
if (init_done) {
hmm_cleanup();
init_done = 0;
}
}
static void *my_userptr;
static unsigned my_num_pages;
static enum hrt_userptr_type my_usr_type;
void hrt_isp_css_mm_set_user_ptr(void *userptr,
unsigned int num_pages,
enum hrt_userptr_type type)
{
my_userptr = userptr;
my_num_pages = num_pages;
my_usr_type = type;
}
static ia_css_ptr __hrt_isp_css_mm_alloc(size_t bytes, void *userptr,
unsigned int num_pages,
enum hrt_userptr_type type,
bool cached)
{
if (!init_done)
hrt_isp_css_mm_init();
#ifdef CONFIG_ION
if (type == HRT_USR_ION)
return hmm_alloc(bytes, HMM_BO_ION, 0,
userptr, cached);
#endif
if (type == HRT_USR_PTR) {
if (userptr == NULL)
return hmm_alloc(bytes, HMM_BO_PRIVATE, 0,
0, cached);
else {
if (num_pages < ((__page_align(bytes)) >> PAGE_SHIFT))
dev_err(atomisp_dev,
"user space memory size is less"
" than the expected size..\n");
else if (num_pages > ((__page_align(bytes))
>> PAGE_SHIFT))
dev_err(atomisp_dev,
"user space memory size is"
" large than the expected size..\n");
return hmm_alloc(bytes, HMM_BO_USER, 0,
userptr, cached);
}
} else {
dev_err(atomisp_dev, "user ptr type is incorrect.\n");
return 0;
}
}
ia_css_ptr hrt_isp_css_mm_alloc(size_t bytes)
{
return __hrt_isp_css_mm_alloc(bytes, my_userptr,
my_num_pages, my_usr_type, false);
}
ia_css_ptr hrt_isp_css_mm_alloc_user_ptr(size_t bytes, void *userptr,
unsigned int num_pages,
enum hrt_userptr_type type,
bool cached)
{
return __hrt_isp_css_mm_alloc(bytes, userptr, num_pages,
type, cached);
}
ia_css_ptr hrt_isp_css_mm_alloc_cached(size_t bytes)
{
if (!init_done)
hrt_isp_css_mm_init();
if (my_userptr == NULL)
return hmm_alloc(bytes, HMM_BO_PRIVATE, 0, 0,
HMM_CACHED);
else {
if (my_num_pages < ((__page_align(bytes)) >> PAGE_SHIFT))
dev_err(atomisp_dev,
"user space memory size is less"
" than the expected size..\n");
else if (my_num_pages > ((__page_align(bytes)) >> PAGE_SHIFT))
dev_err(atomisp_dev,
"user space memory size is"
" large than the expected size..\n");
return hmm_alloc(bytes, HMM_BO_USER, 0,
my_userptr, HMM_CACHED);
}
}
ia_css_ptr hrt_isp_css_mm_calloc(size_t bytes)
{
ia_css_ptr ptr = hrt_isp_css_mm_alloc(bytes);
if (ptr)
hmm_set(ptr, 0, bytes);
return ptr;
}
ia_css_ptr hrt_isp_css_mm_calloc_cached(size_t bytes)
{
ia_css_ptr ptr = hrt_isp_css_mm_alloc_cached(bytes);
if (ptr)
hmm_set(ptr, 0, bytes);
return ptr;
}
phys_addr_t hrt_isp_css_virt_to_phys(ia_css_ptr virt_addr)
{
return hmm_virt_to_phys(virt_addr);
}
|
