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
47using std::mutex;
48using std::lock_guard;
49using std::begin;
50using std::copy;
51using std::end;
52using std::fill;
53
54namespace drm_utils {
55
56DRMLogger *DRMLogger::s_instance = nullptr;
57DRMMaster *DRMMaster::s_instance = nullptr;
58mutex DRMMaster::s_lock;
59
60int 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
76void DRMMaster::DestroyInstance() {
77  lock_guard<mutex> obj(s_lock);
78  delete s_instance;
79  s_instance = nullptr;
80}
81
82int 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
92DRMMaster::~DRMMaster() {
93  drmClose(dev_fd_);
94  dev_fd_ = -1;
95}
96
97int DRMMaster::CreateFbId(const DRMBuffer &drm_buffer, uint32_t *fb_id) {
98  uint32_t gem_handle = 0;
99  int ret = drmPrimeFDToHandle(dev_fd_, drm_buffer.fd, &gem_handle);
100  if (ret) {
101    DRM_LOGE("drmPrimeFDToHandle failed with error %d", ret);
102    return ret;
103  }
104
105  struct drm_mode_fb_cmd2 cmd2 {};
106  cmd2.width = drm_buffer.width;
107  cmd2.height = drm_buffer.height;
108  cmd2.pixel_format = drm_buffer.drm_format;
109  cmd2.flags = DRM_MODE_FB_MODIFIERS;
110  fill(begin(cmd2.handles), begin(cmd2.handles) + drm_buffer.num_planes, gem_handle);
111  copy(begin(drm_buffer.stride), end(drm_buffer.stride), begin(cmd2.pitches));
112  copy(begin(drm_buffer.offset), end(drm_buffer.offset), begin(cmd2.offsets));
113  fill(begin(cmd2.modifier), begin(cmd2.modifier) + drm_buffer.num_planes,
114       drm_buffer.drm_format_modifier);
115
116  if ((ret = drmIoctl(dev_fd_, DRM_IOCTL_MODE_ADDFB2, &cmd2))) {
117    DRM_LOGE("DRM_IOCTL_MODE_ADDFB2 failed with error %d", ret);
118  } else {
119    *fb_id = cmd2.fb_id;
120  }
121
122  struct drm_gem_close gem_close = {};
123  gem_close.handle = gem_handle;
124  int ret1 = drmIoctl(dev_fd_, DRM_IOCTL_GEM_CLOSE, &gem_close);
125  if (ret1) {
126    DRM_LOGE("drmIoctl::DRM_IOCTL_GEM_CLOSE failed with error %d", ret1);
127    return ret1;
128  }
129
130  return ret;
131}
132
133int DRMMaster::RemoveFbId(uint32_t fb_id) {
134  int ret = 0;
135#ifdef DRM_IOCTL_MSM_RMFB2
136  ret = drmIoctl(dev_fd_, DRM_IOCTL_MSM_RMFB2, &fb_id);
137  if (ret) {
138    DRM_LOGE("drmIoctl::DRM_IOCTL_MSM_RMFB2 failed for fb_id %d with error %d", fb_id, errno);
139  }
140#else
141  ret = drmModeRmFB(dev_fd_, fb_id);
142  if (ret) {
143    DRM_LOGE("drmModeRmFB failed for fb_id %d with error %d", fb_id, ret);
144  }
145#endif
146  return ret;
147}
148
149}  // namespace drm_utils
150