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 void DRMMaster::DestroyInstance() { 77 lock_guard<mutex> obj(s_lock); 78 delete s_instance; 79 s_instance = nullptr; 80 } 81 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 92 DRMMaster::~DRMMaster() { 93 drmClose(dev_fd_); 94 dev_fd_ = -1; 95 } 96 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 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
