#include <stdio.h>
#include <unistd.h>
#include <fcntl.h>
#include <utility>
#include <stdexcept>
#include <string.h>
#include <algorithm>
#include <cerrno>
#include <xf86drm.h>
#include <xf86drmMode.h>
#include <kms++/kms++.h>
using namespace std;
namespace kms
{
Card::Card()
: Card("/dev/dri/card0")
{
}
Card::Card(const std::string& device)
{
int fd = open(device.c_str(), O_RDWR | O_CLOEXEC);
if (fd < 0)
throw invalid_argument(string(strerror(errno)) + " opening " + device);
m_fd = fd;
int r;
r = drmSetMaster(fd);
m_master = r == 0;
if (getenv("KMSXX_DISABLE_UNIVERSAL_PLANES") == 0) {
r = drmSetClientCap(m_fd, DRM_CLIENT_CAP_UNIVERSAL_PLANES, 1);
m_has_universal_planes = r == 0;
} else {
m_has_universal_planes = false;
}
#ifdef DRM_CLIENT_CAP_ATOMIC
if (getenv("KMSXX_DISABLE_ATOMIC") == 0) {
r = drmSetClientCap(m_fd, DRM_CLIENT_CAP_ATOMIC, 1);
m_has_atomic = r == 0;
} else {
m_has_atomic = false;
}
#else
m_has_atomic = false;
#endif
uint64_t has_dumb;
r = drmGetCap(fd, DRM_CAP_DUMB_BUFFER, &has_dumb);
if (r || !has_dumb)
throw invalid_argument("Dumb buffers not available");
auto res = drmModeGetResources(m_fd);
if (!res)
throw invalid_argument("Can't get card resources");
for (int i = 0; i < res->count_connectors; ++i) {
uint32_t id = res->connectors[i];
auto ob = new Connector(*this, id, i);
m_obmap[id] = ob;
m_connectors.push_back(ob);
}
for (int i = 0; i < res->count_crtcs; ++i) {
uint32_t id = res->crtcs[i];
auto ob = new Crtc(*this, id, i);
m_obmap[id] = ob;
m_crtcs.push_back(ob);
}
for (int i = 0; i < res->count_encoders; ++i) {
uint32_t id = res->encoders[i];
auto ob = new Encoder(*this, id, i);
m_obmap[id] = ob;
m_encoders.push_back(ob);
}
drmModeFreeResources(res);
auto planeRes = drmModeGetPlaneResources(m_fd);
for (uint i = 0; i < planeRes->count_planes; ++i) {
uint32_t id = planeRes->planes[i];
auto ob = new Plane(*this, id, i);
m_obmap[id] = ob;
m_planes.push_back(ob);
}
drmModeFreePlaneResources(planeRes);
// collect all possible props
for (auto ob : get_objects()) {
auto props = drmModeObjectGetProperties(m_fd, ob->id(), ob->object_type());
if (props == nullptr)
continue;
for (unsigned i = 0; i < props->count_props; ++i) {
uint32_t prop_id = props->props[i];
if (m_obmap.find(prop_id) == m_obmap.end()) {
auto ob = new Property(*this, prop_id);
m_obmap[prop_id] = ob;
m_properties.push_back(ob);
}
}
drmModeFreeObjectProperties(props);
}
for (auto pair : m_obmap)
pair.second->setup();
}
Card::~Card()
{
restore_modes();
while (m_framebuffers.size() > 0)
delete m_framebuffers.back();
for (auto pair : m_obmap)
delete pair.second;
close(m_fd);
}
void Card::drop_master()
{
drmDropMaster(fd());
}
void Card::restore_modes()
{
for (auto conn : get_connectors())
conn->restore_mode();
}
Connector* Card::get_first_connected_connector() const
{
for(auto c : m_connectors) {
if (c->connected())
return c;
}
throw invalid_argument("no connected connectors");
}
DrmObject* Card::get_object(uint32_t id) const
{
auto iter = m_obmap.find(id);
if (iter != m_obmap.end())
return iter->second;
return nullptr;
}
const vector<DrmObject*> Card::get_objects() const
{
vector<DrmObject*> v;
for(auto pair : m_obmap)
v.push_back(pair.second);
return v;
}
Connector* Card::get_connector(uint32_t id) const { return dynamic_cast<Connector*>(get_object(id)); }
Crtc* Card::get_crtc(uint32_t id) const { return dynamic_cast<Crtc*>(get_object(id)); }
Encoder* Card::get_encoder(uint32_t id) const { return dynamic_cast<Encoder*>(get_object(id)); }
Property* Card::get_prop(uint32_t id) const { return dynamic_cast<Property*>(get_object(id)); }
Plane* Card::get_plane(uint32_t id) const { return dynamic_cast<Plane*>(get_object(id)); }
std::vector<kms::Pipeline> Card::get_connected_pipelines()
{
vector<Pipeline> outputs;
for (auto conn : get_connectors())
{
if (conn->connected() == false)
continue;
Crtc* crtc = conn->get_current_crtc();
if (!crtc) {
for (auto possible : conn->get_possible_crtcs()) {
if (find_if(outputs.begin(), outputs.end(), [possible](Pipeline out) { return out.crtc == possible; }) == outputs.end()) {
crtc = possible;
break;
}
}
}
if (!crtc)
throw invalid_argument(string("Connector #") +
to_string(conn->idx()) +
" has no possible crtcs");
outputs.push_back(Pipeline { crtc, conn });
}
return outputs;
}
static void page_flip_handler(int fd, unsigned int frame,
unsigned int sec, unsigned int usec,
void *data)
{
auto handler = (PageFlipHandlerBase*)data;
double time = sec + usec / 1000000.0;
handler->handle_page_flip(frame, time);
}
void Card::call_page_flip_handlers()
{
drmEventContext ev { };
ev.version = DRM_EVENT_CONTEXT_VERSION;
ev.page_flip_handler = page_flip_handler;
drmHandleEvent(fd(), &ev);
}
int Card::disable_all()
{
AtomicReq req(*this);
for (Crtc* c : m_crtcs) {
req.add(c, {
{ "ACTIVE", 0 },
});
}
for (Plane* p : m_planes) {
req.add(p, {
{ "FB_ID", 0 },
{ "CRTC_ID", 0 },
});
}
return req.commit_sync(true);
}
}