1 /*
2 * Copyright (c) 2017, 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 #include <errno.h>
31 #include <fcntl.h>
32 #include <sys/stat.h>
33 #include <unistd.h>
34 #include <xf86drm.h>
35 #include <xf86drmMode.h>
36 // Intentionally included after xf86 headers so that they in-turn include libdrm version of drm.h
37 // that doesn't use keyword "virtual" for a variable name. Not doing so leads to the kernel version
38 // of drm.h being included causing compilation to fail
39 #include <drm/msm_drm.h>
40 #include <algorithm>
41 #include <iterator>
42
43 #include "drm_master.h"
44
45 #define __CLASS__ "DRMMaster"
46
47 using std::mutex;
48 using std::lock_guard;
49 using std::begin;
50 using std::copy;
51 using std::end;
52 using std::fill;
53
54 namespace drm_utils {
55
56 DRMLogger *DRMLogger::s_instance = nullptr;
57 DRMMaster *DRMMaster::s_instance = nullptr;
58 mutex DRMMaster::s_lock;
59
GetInstance(DRMMaster ** master)60 int DRMMaster::GetInstance(DRMMaster **master) {
61 lock_guard<mutex> obj(s_lock);
62
63 if (!s_instance) {
64 s_instance = new DRMMaster();
65 if (s_instance->Init() < 0) {
66 delete s_instance;
67 s_instance = nullptr;
68 return -ENODEV;
69 }
70 }
71
72 *master = s_instance;
73 return 0;
74 }
75
DestroyInstance()76 void DRMMaster::DestroyInstance() {
77 lock_guard<mutex> obj(s_lock);
78 delete s_instance;
79 s_instance = nullptr;
80 }
81
Init()82 int DRMMaster::Init() {
83 dev_fd_ = drmOpen("msm_drm", nullptr);
84 if (dev_fd_ < 0) {
85 DRM_LOGE("drmOpen failed with error %d", dev_fd_);
86 return -ENODEV;
87 }
88
89 return 0;
90 }
91
~DRMMaster()92 DRMMaster::~DRMMaster() {
93 drmClose(dev_fd_);
94 dev_fd_ = -1;
95 }
96
CreateFbId(const DRMBuffer & drm_buffer,uint32_t * gem_handle,uint32_t * fb_id)97 int DRMMaster::CreateFbId(const DRMBuffer &drm_buffer, uint32_t *gem_handle, uint32_t *fb_id) {
98 int ret = drmPrimeFDToHandle(dev_fd_, drm_buffer.fd, gem_handle);
99 if (ret) {
100 DRM_LOGE("drmPrimeFDToHandle failed with error %d", ret);
101 return ret;
102 }
103
104 struct drm_mode_fb_cmd2 cmd2 {};
105 cmd2.width = drm_buffer.width;
106 cmd2.height = drm_buffer.height;
107 cmd2.pixel_format = drm_buffer.drm_format;
108 cmd2.flags = DRM_MODE_FB_MODIFIERS;
109 fill(begin(cmd2.handles), begin(cmd2.handles) + drm_buffer.num_planes, *gem_handle);
110 copy(begin(drm_buffer.stride), end(drm_buffer.stride), begin(cmd2.pitches));
111 copy(begin(drm_buffer.offset), end(drm_buffer.offset), begin(cmd2.offsets));
112 fill(begin(cmd2.modifier), begin(cmd2.modifier) + drm_buffer.num_planes,
113 drm_buffer.drm_format_modifier);
114
115 if ((ret = drmIoctl(dev_fd_, DRM_IOCTL_MODE_ADDFB2, &cmd2))) {
116 DRM_LOGE("DRM_IOCTL_MODE_ADDFB2 failed with error %d", ret);
117 struct drm_gem_close gem_close = {};
118 gem_close.handle = *gem_handle;
119 int ret1 = drmIoctl(dev_fd_, DRM_IOCTL_GEM_CLOSE, &gem_close);
120 if (ret1) {
121 DRM_LOGE("drmIoctl::DRM_IOCTL_GEM_CLOSE failed with error %d", ret1);
122 return ret1;
123 }
124 return ret;
125 }
126
127 *fb_id = cmd2.fb_id;
128 return 0;
129 }
130
RemoveFbId(uint32_t gem_handle,uint32_t fb_id)131 int DRMMaster::RemoveFbId(uint32_t gem_handle, uint32_t fb_id) {
132 struct drm_gem_close gem_close = {};
133 gem_close.handle = gem_handle;
134 int ret = drmIoctl(dev_fd_, DRM_IOCTL_GEM_CLOSE, &gem_close);
135 if (ret) {
136 DRM_LOGE("drmIoctl::DRM_IOCTL_GEM_CLOSE failed with error %d", errno);
137 }
138
139 #ifdef DRM_IOCTL_MSM_RMFB2
140 ret = drmIoctl(dev_fd_, DRM_IOCTL_MSM_RMFB2, &fb_id);
141 if (ret) {
142 DRM_LOGE("drmIoctl::DRM_IOCTL_MSM_RMFB2 failed for fb_id %d with error %d", fb_id, errno);
143 }
144 #else
145 ret = drmModeRmFB(dev_fd_, fb_id);
146 if (ret) {
147 DRM_LOGE("drmModeRmFB failed for fb_id %d with error %d", fb_id, ret);
148 }
149 #endif
150 return ret;
151 }
152
153 } // namespace drm_utils
154