1/*
2 * Copyright (c) 2011-2014, The Linux Foundation. All rights reserved.
3
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions are
6 * met:
7 *   * Redistributions of source code must retain the above copyright
8 *     notice, this list of conditions and the following disclaimer.
9 *   * Redistributions in binary form must reproduce the above
10 *     copyright notice, this list of conditions and the following
11 *     disclaimer in the documentation and/or other materials provided
12 *     with the distribution.
13 *   * Neither the name of The Linux Foundation nor the names of its
14 *     contributors may be used to endorse or promote products derived
15 *     from this software without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
18 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
19 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
20 * ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
21 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
22 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
23 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
24 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
25 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
26 * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
27 * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 */
29
30#define DEBUG 0
31#define ATRACE_TAG (ATRACE_TAG_GRAPHICS | ATRACE_TAG_HAL)
32#include <sys/ioctl.h>
33#include <sys/mman.h>
34#include <stdlib.h>
35#include <fcntl.h>
36#include <cutils/log.h>
37#include <errno.h>
38#include <utils/Trace.h>
39#include <cutils/trace.h>
40#include "gralloc_priv.h"
41#include "ionalloc.h"
42
43using gralloc::IonAlloc;
44
45#define ION_DEVICE "/dev/ion"
46
47int IonAlloc::open_device()
48{
49    if(mIonFd == FD_INIT)
50        mIonFd = open(ION_DEVICE, O_RDONLY);
51
52    if(mIonFd < 0 ) {
53        ALOGE("%s: Failed to open ion device - %s",
54              __FUNCTION__, strerror(errno));
55        mIonFd = FD_INIT;
56        return -errno;
57    }
58    return 0;
59}
60
61void IonAlloc::close_device()
62{
63    if(mIonFd >= 0)
64        close(mIonFd);
65    mIonFd = FD_INIT;
66}
67
68int IonAlloc::alloc_buffer(alloc_data& data)
69{
70    ATRACE_CALL();
71    Locker::Autolock _l(mLock);
72    int err = 0;
73    struct ion_handle_data handle_data;
74    struct ion_fd_data fd_data;
75    struct ion_allocation_data ionAllocData;
76    void *base = 0;
77
78    ionAllocData.len = data.size;
79    ionAllocData.align = data.align;
80    ionAllocData.heap_id_mask = data.heapId;
81    ionAllocData.flags = data.flags;
82    ionAllocData.flags |= data.uncached ? 0 : ION_FLAG_CACHED;
83    err = open_device();
84    if (err)
85        return err;
86    if(ioctl(mIonFd, ION_IOC_ALLOC, &ionAllocData)) {
87        err = -errno;
88        ALOGE("ION_IOC_ALLOC failed with error - %s", strerror(errno));
89        return err;
90    }
91
92    fd_data.handle = ionAllocData.handle;
93    handle_data.handle = ionAllocData.handle;
94    if(ioctl(mIonFd, ION_IOC_MAP, &fd_data)) {
95        err = -errno;
96        ALOGE("%s: ION_IOC_MAP failed with error - %s",
97              __FUNCTION__, strerror(errno));
98        ioctl(mIonFd, ION_IOC_FREE, &handle_data);
99        return err;
100    }
101
102    if(!(data.flags & ION_SECURE)) {
103        base = mmap(0, ionAllocData.len, PROT_READ|PROT_WRITE,
104                    MAP_SHARED, fd_data.fd, 0);
105        if(base == MAP_FAILED) {
106            err = -errno;
107            ALOGE("%s: Failed to map the allocated memory: %s",
108                  __FUNCTION__, strerror(errno));
109            ioctl(mIonFd, ION_IOC_FREE, &handle_data);
110            return err;
111        }
112    }
113
114    data.base = base;
115    data.fd = fd_data.fd;
116    ioctl(mIonFd, ION_IOC_FREE, &handle_data);
117    ALOGD_IF(DEBUG, "ion: Allocated buffer base:%p size:%zu fd:%d",
118          data.base, ionAllocData.len, data.fd);
119    return 0;
120}
121
122
123int IonAlloc::free_buffer(void* base, unsigned int size, unsigned int offset,
124        int fd)
125{
126    ATRACE_CALL();
127    Locker::Autolock _l(mLock);
128    ALOGD_IF(DEBUG, "ion: Freeing buffer base:%p size:%u fd:%d",
129          base, size, fd);
130    int err = 0;
131    err = open_device();
132    if (err)
133        return err;
134
135    if(base)
136        err = unmap_buffer(base, size, offset);
137    close(fd);
138    return err;
139}
140
141int IonAlloc::map_buffer(void **pBase, unsigned int size, unsigned int offset,
142        int fd)
143{
144    ATRACE_CALL();
145    int err = 0;
146    void *base = 0;
147    // It is a (quirky) requirement of ION to have opened the
148    // ion fd in the process that is doing the mapping
149    err = open_device();
150    if (err)
151        return err;
152
153    base = mmap(0, size, PROT_READ| PROT_WRITE,
154                MAP_SHARED, fd, 0);
155    *pBase = base;
156    if(base == MAP_FAILED) {
157        err = -errno;
158        ALOGE("ion: Failed to map memory in the client: %s",
159              strerror(errno));
160    } else {
161        ALOGD_IF(DEBUG, "ion: Mapped buffer base:%p size:%u offset:%u fd:%d",
162              base, size, offset, fd);
163    }
164    return err;
165}
166
167int IonAlloc::unmap_buffer(void *base, unsigned int size,
168        unsigned int /*offset*/)
169{
170    ATRACE_CALL();
171    ALOGD_IF(DEBUG, "ion: Unmapping buffer  base:%p size:%u", base, size);
172    int err = 0;
173    if(munmap(base, size)) {
174        err = -errno;
175        ALOGE("ion: Failed to unmap memory at %p : %s",
176              base, strerror(errno));
177    }
178    return err;
179
180}
181int IonAlloc::clean_buffer(void *base, unsigned int size, unsigned int offset,
182        int fd, int op)
183{
184    ATRACE_CALL();
185    ATRACE_INT("operation id", op);
186    struct ion_flush_data flush_data;
187    struct ion_fd_data fd_data;
188    struct ion_handle_data handle_data;
189    int err = 0;
190
191    err = open_device();
192    if (err)
193        return err;
194
195    fd_data.fd = fd;
196    if (ioctl(mIonFd, ION_IOC_IMPORT, &fd_data)) {
197        err = -errno;
198        ALOGE("%s: ION_IOC_IMPORT failed with error - %s",
199              __FUNCTION__, strerror(errno));
200        return err;
201    }
202
203    handle_data.handle = fd_data.handle;
204    flush_data.handle  = fd_data.handle;
205    flush_data.vaddr   = base;
206    // offset and length are unsigned int
207    flush_data.offset  = offset;
208    flush_data.length  = size;
209
210    struct ion_custom_data d;
211    switch(op) {
212    case CACHE_CLEAN:
213        d.cmd = ION_IOC_CLEAN_CACHES;
214        break;
215    case CACHE_INVALIDATE:
216            d.cmd = ION_IOC_INV_CACHES;
217        break;
218    case CACHE_CLEAN_AND_INVALIDATE:
219    default:
220        d.cmd = ION_IOC_CLEAN_INV_CACHES;
221    }
222
223    d.arg = (unsigned long int)&flush_data;
224
225    if(ioctl(mIonFd, ION_IOC_CUSTOM, &d)) {
226        err = -errno;
227        ALOGE("%s: ION_IOC_CLEAN_INV_CACHES failed with error - %s",
228
229              __FUNCTION__, strerror(errno));
230        ioctl(mIonFd, ION_IOC_FREE, &handle_data);
231        return err;
232    }
233    ioctl(mIonFd, ION_IOC_FREE, &handle_data);
234    return 0;
235}
236
237