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 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 76 int DRMMaster::Init() { 77 dev_fd_ = drmOpen("msm_drm", nullptr); 78 if (dev_fd_ < 0) { 79 DRM_LOGE("drmOpen failed with error %d", dev_fd_); 80 return -ENODEV; 81 } 82 83 return 0; 84 } 85 86 DRMMaster::~DRMMaster() { 87 drmClose(dev_fd_); 88 dev_fd_ = -1; 89 } 90 91 int DRMMaster::CreateFbId(const DRMBuffer &drm_buffer, uint32_t *gem_handle, uint32_t *fb_id) { 92 int ret = drmPrimeFDToHandle(dev_fd_, drm_buffer.fd, gem_handle); 93 if (ret) { 94 DRM_LOGE("drmPrimeFDToHandle failed with error %d", ret); 95 return ret; 96 } 97 98 struct drm_mode_fb_cmd2 cmd2 {}; 99 cmd2.width = drm_buffer.width; 100 cmd2.height = drm_buffer.height; 101 cmd2.pixel_format = drm_buffer.drm_format; 102 cmd2.flags = DRM_MODE_FB_MODIFIERS; 103 fill(begin(cmd2.handles), begin(cmd2.handles) + drm_buffer.num_planes, *gem_handle); 104 copy(begin(drm_buffer.stride), end(drm_buffer.stride), begin(cmd2.pitches)); 105 copy(begin(drm_buffer.offset), end(drm_buffer.offset), begin(cmd2.offsets)); 106 fill(begin(cmd2.modifier), begin(cmd2.modifier) + drm_buffer.num_planes, 107 drm_buffer.drm_format_modifier); 108 109 if ((ret = drmIoctl(dev_fd_, DRM_IOCTL_MODE_ADDFB2, &cmd2))) { 110 DRM_LOGE("DRM_IOCTL_MODE_ADDFB2 failed with error %d", ret); 111 struct drm_gem_close gem_close = {}; 112 gem_close.handle = *gem_handle; 113 int ret1 = drmIoctl(dev_fd_, DRM_IOCTL_GEM_CLOSE, &gem_close); 114 if (ret1) { 115 DRM_LOGE("drmIoctl::DRM_IOCTL_GEM_CLOSE failed with error %d", ret1); 116 return ret1; 117 } 118 return ret; 119 } 120 121 *fb_id = cmd2.fb_id; 122 return 0; 123 } 124 125 int DRMMaster::RemoveFbId(uint32_t gem_handle, uint32_t fb_id) { 126 struct drm_gem_close gem_close = {}; 127 gem_close.handle = gem_handle; 128 int ret = drmIoctl(dev_fd_, DRM_IOCTL_GEM_CLOSE, &gem_close); 129 if (ret) { 130 DRM_LOGE("drmIoctl::DRM_IOCTL_GEM_CLOSE failed with error %d", errno); 131 } 132 133 #ifdef DRM_IOCTL_MSM_RMFB2 134 ret = drmIoctl(dev_fd_, DRM_IOCTL_MSM_RMFB2, &fb_id); 135 if (ret) { 136 DRM_LOGE("drmIoctl::DRM_IOCTL_MSM_RMFB2 failed for fb_id %d with error %d", fb_id, errno); 137 } 138 #else 139 ret = drmModeRmFB(dev_fd_, fb_id); 140 if (ret) { 141 DRM_LOGE("drmModeRmFB failed for fb_id %d with error %d", fb_id, ret); 142 } 143 #endif 144 return ret; 145 } 146 147 } // namespace drm_utils 148