1 /* Copyright (c) 2013-2014, The Linux Foundation. All rights reserved.
2 *
3 * Redistribution and use in source and binary forms, with or without
4 * modification, are permitted provided that the following conditions are
5 * met:
6 * * Redistributions of source code must retain the above copyright
7 * notice, this list of conditions and the following disclaimer.
8 * * Redistributions in binary form must reproduce the above
9 * copyright notice, this list of conditions and the following
10 * disclaimer in the documentation and/or other materials provided
11 * with the distribution.
12 * * Neither the name of The Linux Foundation nor the names of its
13 * contributors may be used to endorse or promote products derived
14 * from this software without specific prior written permission.
15 *
16 * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
17 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
18 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
20 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
23 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
24 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
25 * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
26 * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 *
28 */
29
30 #include "mm_jpeg_ionbuf.h"
31 #include <stdio.h>
32 #include <string.h>
33 #include <linux/msm_ion.h>
34
35 /** buffer_allocate:
36 *
37 * Arguments:
38 * @p_buffer: ION buffer
39 *
40 * Return:
41 * buffer address
42 *
43 * Description:
44 * allocates ION buffer
45 *
46 **/
buffer_allocate(buffer_t * p_buffer,int cached)47 void *buffer_allocate(buffer_t *p_buffer, int cached)
48 {
49 void *l_buffer = NULL;
50
51 int lrc = 0;
52 struct ion_handle_data lhandle_data;
53
54 p_buffer->alloc.len = p_buffer->size;
55 p_buffer->alloc.align = 4096;
56 p_buffer->alloc.flags = (cached) ? ION_FLAG_CACHED : 0;
57 p_buffer->alloc.heap_id_mask = 0x1 << ION_IOMMU_HEAP_ID;
58
59 p_buffer->ion_fd = open("/dev/ion", O_RDONLY);
60 if(p_buffer->ion_fd < 0) {
61 CDBG_ERROR("%s :Ion open failed", __func__);
62 goto ION_ALLOC_FAILED;
63 }
64
65 /* Make it page size aligned */
66 p_buffer->alloc.len = (p_buffer->alloc.len + 4095U) & (~4095U);
67 lrc = ioctl(p_buffer->ion_fd, ION_IOC_ALLOC, &p_buffer->alloc);
68 if (lrc < 0) {
69 CDBG_ERROR("%s :ION allocation failed len %zu", __func__,
70 p_buffer->alloc.len);
71 goto ION_ALLOC_FAILED;
72 }
73
74 p_buffer->ion_info_fd.handle = p_buffer->alloc.handle;
75 lrc = ioctl(p_buffer->ion_fd, ION_IOC_SHARE,
76 &p_buffer->ion_info_fd);
77 if (lrc < 0) {
78 CDBG_ERROR("%s :ION map failed %s", __func__, strerror(errno));
79 goto ION_MAP_FAILED;
80 }
81
82 p_buffer->p_pmem_fd = p_buffer->ion_info_fd.fd;
83
84 l_buffer = mmap(NULL, p_buffer->alloc.len, PROT_READ | PROT_WRITE,
85 MAP_SHARED,p_buffer->p_pmem_fd, 0);
86
87 if (l_buffer == MAP_FAILED) {
88 CDBG_ERROR("%s :ION_MMAP_FAILED: %s (%d)", __func__,
89 strerror(errno), errno);
90 goto ION_MAP_FAILED;
91 }
92
93 return l_buffer;
94
95 ION_MAP_FAILED:
96 lhandle_data.handle = p_buffer->ion_info_fd.handle;
97 ioctl(p_buffer->ion_fd, ION_IOC_FREE, &lhandle_data);
98 return NULL;
99 ION_ALLOC_FAILED:
100 return NULL;
101
102 }
103
104 /** buffer_deallocate:
105 *
106 * Arguments:
107 * @p_buffer: ION buffer
108 *
109 * Return:
110 * buffer address
111 *
112 * Description:
113 * deallocates ION buffer
114 *
115 **/
buffer_deallocate(buffer_t * p_buffer)116 int buffer_deallocate(buffer_t *p_buffer)
117 {
118 int lrc = 0;
119 size_t lsize = (p_buffer->size + 4095U) & (~4095U);
120
121 struct ion_handle_data lhandle_data;
122 lrc = munmap(p_buffer->addr, lsize);
123
124 close(p_buffer->ion_info_fd.fd);
125
126 lhandle_data.handle = p_buffer->ion_info_fd.handle;
127 ioctl(p_buffer->ion_fd, ION_IOC_FREE, &lhandle_data);
128
129 close(p_buffer->ion_fd);
130 return lrc;
131 }
132
133 /** buffer_invalidate:
134 *
135 * Arguments:
136 * @p_buffer: ION buffer
137 *
138 * Return:
139 * error val
140 *
141 * Description:
142 * Invalidates the cached buffer
143 *
144 **/
buffer_invalidate(buffer_t * p_buffer)145 int buffer_invalidate(buffer_t *p_buffer)
146 {
147 int lrc = 0;
148 struct ion_flush_data cache_inv_data;
149 struct ion_custom_data custom_data;
150
151 memset(&cache_inv_data, 0, sizeof(cache_inv_data));
152 memset(&custom_data, 0, sizeof(custom_data));
153 cache_inv_data.vaddr = p_buffer->addr;
154 cache_inv_data.fd = p_buffer->ion_info_fd.fd;
155 cache_inv_data.handle = p_buffer->ion_info_fd.handle;
156 cache_inv_data.length = (unsigned int)p_buffer->size;
157 custom_data.cmd = (unsigned int)ION_IOC_INV_CACHES;
158 custom_data.arg = (unsigned long)&cache_inv_data;
159
160 lrc = ioctl(p_buffer->ion_fd, ION_IOC_CUSTOM, &custom_data);
161 if (lrc < 0)
162 CDBG_ERROR("%s: Cache Invalidate failed: %s\n", __func__, strerror(errno));
163
164 return lrc;
165 }
166