mm_jpeg_ionbuf.c revision 6f83d735d8e3b918da42e6b559fcd0efb78133e5 
1/* Copyright (c) 2013, 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 <sys/ioctl.h>
31#include <linux/msm_ion.h>
32#include "mm_jpeg_ionbuf.h"
33
34/** buffer_allocate:
35 *
36 *  Arguments:
37 *     @p_buffer: ION buffer
38 *
39 *  Return:
40 *     buffer address
41 *
42 *  Description:
43 *      allocates ION buffer
44 *
45 **/
46void *buffer_allocate(buffer_test_t *p_buffer)
47{
48  void *l_buffer = NULL;
49
50  int lrc = 0;
51  struct ion_handle_data lhandle_data;
52
53   p_buffer->alloc.len = p_buffer->size;
54   p_buffer->alloc.align = 4096;
55   p_buffer->alloc.flags = ION_FLAG_CACHED;
56   p_buffer->alloc.heap_mask = 0x1 << ION_IOMMU_HEAP_ID;
57
58   p_buffer->ion_fd = open("/dev/ion", O_RDONLY);
59   if(p_buffer->ion_fd < 0) {
60    CDBG_ERROR("%s :Ion open failed", __func__);
61    goto ION_ALLOC_FAILED;
62  }
63
64  /* Make it page size aligned */
65  p_buffer->alloc.len = (p_buffer->alloc.len + 4095) & (~4095);
66  lrc = ioctl(p_buffer->ion_fd, ION_IOC_ALLOC, &p_buffer->alloc);
67  if (lrc < 0) {
68    CDBG_ERROR("%s :ION allocation failed len %d", __func__,
69      p_buffer->alloc.len);
70    goto ION_ALLOC_FAILED;
71  }
72
73  p_buffer->ion_info_fd.handle = p_buffer->alloc.handle;
74  lrc = ioctl(p_buffer->ion_fd, ION_IOC_SHARE,
75    &p_buffer->ion_info_fd);
76  if (lrc < 0) {
77    CDBG_ERROR("%s :ION map failed %s", __func__, strerror(errno));
78    goto ION_MAP_FAILED;
79  }
80
81  p_buffer->p_pmem_fd = p_buffer->ion_info_fd.fd;
82
83  l_buffer = mmap(NULL, p_buffer->alloc.len, PROT_READ  | PROT_WRITE,
84    MAP_SHARED,p_buffer->p_pmem_fd, 0);
85
86  if (l_buffer == MAP_FAILED) {
87    CDBG_ERROR("%s :ION_MMAP_FAILED: %s (%d)", __func__,
88      strerror(errno), errno);
89    goto ION_MAP_FAILED;
90  }
91
92  return l_buffer;
93
94ION_MAP_FAILED:
95  lhandle_data.handle = p_buffer->ion_info_fd.handle;
96  ioctl(p_buffer->ion_fd, ION_IOC_FREE, &lhandle_data);
97  return NULL;
98ION_ALLOC_FAILED:
99  return NULL;
100
101}
102
103/** buffer_deallocate:
104 *
105 *  Arguments:
106 *     @p_buffer: ION buffer
107 *
108 *  Return:
109 *     buffer address
110 *
111 *  Description:
112 *      deallocates ION buffer
113 *
114 **/
115int buffer_deallocate(buffer_test_t *p_buffer)
116{
117  int lrc = 0;
118  int lsize = (p_buffer->size + 4095) & (~4095);
119
120  struct ion_handle_data lhandle_data;
121  lrc = munmap(p_buffer->addr, lsize);
122
123  close(p_buffer->ion_info_fd.fd);
124
125  lhandle_data.handle = p_buffer->ion_info_fd.handle;
126  ioctl(p_buffer->ion_fd, ION_IOC_FREE, &lhandle_data);
127
128  close(p_buffer->ion_fd);
129  return lrc;
130}
131
132
133