b3cdccbff9
The lookupDeviceNode() method is declared as pure virtual in the base DeviceEnumerator class, but is only called by derived classes. Move it to the DeviceEnumeratorSysfs and DeviceEnumeratorUdev. This allows changing the udev version to take a dev_t instead of separate major/minor, as that's what both the caller and the callee end up using. Signed-off-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Reviewed-by: Kieran Bingham <kieran.bingham@ideasonboard.com> Reviewed-by: Paul Elder <paul.elder@ideasonboard.com>
150 lines
3.0 KiB
C++
150 lines
3.0 KiB
C++
/* SPDX-License-Identifier: LGPL-2.1-or-later */
|
|
/*
|
|
* Copyright (C) 2019, Google Inc.
|
|
*
|
|
* device_enumerator_sysfs.cpp - sysfs-based device enumerator
|
|
*/
|
|
|
|
#include "device_enumerator_sysfs.h"
|
|
|
|
#include <dirent.h>
|
|
#include <fcntl.h>
|
|
#include <fstream>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/stat.h>
|
|
#include <sys/types.h>
|
|
#include <unistd.h>
|
|
|
|
#include "log.h"
|
|
#include "media_device.h"
|
|
|
|
namespace libcamera {
|
|
|
|
LOG_DECLARE_CATEGORY(DeviceEnumerator)
|
|
|
|
int DeviceEnumeratorSysfs::init()
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
int DeviceEnumeratorSysfs::enumerate()
|
|
{
|
|
struct dirent *ent;
|
|
DIR *dir;
|
|
int ret = 0;
|
|
|
|
static const char * const sysfs_dirs[] = {
|
|
"/sys/subsystem/media/devices",
|
|
"/sys/bus/media/devices",
|
|
"/sys/class/media/devices",
|
|
};
|
|
|
|
for (const char *dirname : sysfs_dirs) {
|
|
dir = opendir(dirname);
|
|
if (dir)
|
|
break;
|
|
}
|
|
|
|
if (!dir) {
|
|
LOG(DeviceEnumerator, Error)
|
|
<< "No valid sysfs media device directory";
|
|
return -ENODEV;
|
|
}
|
|
|
|
while ((ent = readdir(dir)) != nullptr) {
|
|
if (strncmp(ent->d_name, "media", 5))
|
|
continue;
|
|
|
|
char *end;
|
|
unsigned int idx = strtoul(ent->d_name + 5, &end, 10);
|
|
if (*end != '\0')
|
|
continue;
|
|
|
|
std::string devnode = "/dev/media" + std::to_string(idx);
|
|
|
|
/* Verify that the device node exists. */
|
|
struct stat devstat;
|
|
if (stat(devnode.c_str(), &devstat) < 0) {
|
|
LOG(DeviceEnumerator, Warning)
|
|
<< "Device node /dev/media" << idx
|
|
<< " should exist but doesn't";
|
|
continue;
|
|
}
|
|
|
|
std::shared_ptr<MediaDevice> media = createDevice(devnode);
|
|
if (!media) {
|
|
ret = -ENODEV;
|
|
break;
|
|
}
|
|
|
|
if (populateMediaDevice(media) < 0) {
|
|
ret = -ENODEV;
|
|
break;
|
|
}
|
|
|
|
addDevice(media);
|
|
}
|
|
|
|
closedir(dir);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int DeviceEnumeratorSysfs::populateMediaDevice(const std::shared_ptr<MediaDevice> &media)
|
|
{
|
|
/* Associate entities to device node paths. */
|
|
for (MediaEntity *entity : media->entities()) {
|
|
if (entity->deviceMajor() == 0 && entity->deviceMinor() == 0)
|
|
continue;
|
|
|
|
std::string deviceNode = lookupDeviceNode(entity->deviceMajor(),
|
|
entity->deviceMinor());
|
|
if (deviceNode.empty())
|
|
return -EINVAL;
|
|
|
|
int ret = entity->setDeviceNode(deviceNode);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* \brief Lookup device node path from device number
|
|
* \param[in] major The device major number
|
|
* \param[in] minor The device minor number
|
|
*
|
|
* Translate a device number given as \a major and \a minor to a device node
|
|
* path.
|
|
*
|
|
* \return The device node path on success, or an empty string if the lookup
|
|
* fails
|
|
*/
|
|
std::string DeviceEnumeratorSysfs::lookupDeviceNode(int major, int minor)
|
|
{
|
|
std::string deviceNode;
|
|
std::string line;
|
|
std::ifstream ueventFile;
|
|
|
|
ueventFile.open("/sys/dev/char/" + std::to_string(major) + ":" +
|
|
std::to_string(minor) + "/uevent");
|
|
if (!ueventFile)
|
|
return std::string();
|
|
|
|
while (ueventFile >> line) {
|
|
if (line.find("DEVNAME=") == 0) {
|
|
deviceNode = "/dev/" + line.substr(strlen("DEVNAME="));
|
|
break;
|
|
}
|
|
}
|
|
|
|
ueventFile.close();
|
|
|
|
return deviceNode;
|
|
}
|
|
|
|
} /* namespace libcamera */
|