2021-07-28 09:41:36 +00:00
|
|
|
#include <assert.h>
|
|
|
|
#include <fcntl.h>
|
|
|
|
#include <poll.h>
|
2021-07-27 16:01:04 +00:00
|
|
|
#include <stdio.h>
|
2021-07-28 09:41:36 +00:00
|
|
|
#include <unistd.h>
|
2021-07-27 18:41:31 +00:00
|
|
|
|
2021-07-28 09:41:36 +00:00
|
|
|
#include <atomic>
|
2021-07-27 18:41:31 +00:00
|
|
|
#include <thread>
|
2021-07-28 09:41:36 +00:00
|
|
|
#include <vector>
|
2021-07-27 16:01:04 +00:00
|
|
|
|
|
|
|
#include "main.hpp"
|
|
|
|
#include "pipewire.hpp"
|
2021-08-31 15:03:55 +00:00
|
|
|
#include "log.hpp"
|
|
|
|
|
|
|
|
static LogScope log("pipewire");
|
2021-07-27 16:01:04 +00:00
|
|
|
|
2021-07-29 08:09:10 +00:00
|
|
|
static struct pipewire_state pipewire_state = { .stream_node_id = SPA_ID_INVALID };
|
2021-07-28 09:41:36 +00:00
|
|
|
static int nudgePipe[2] = { -1, -1 };
|
|
|
|
|
|
|
|
static std::atomic<struct pipewire_buffer *> out_buffer;
|
|
|
|
static std::atomic<struct pipewire_buffer *> in_buffer;
|
|
|
|
|
2021-07-28 10:26:39 +00:00
|
|
|
static const struct spa_pod *get_format_param(struct spa_pod_builder *builder) {
|
|
|
|
struct spa_rectangle size = SPA_RECTANGLE(g_nOutputWidth, g_nOutputHeight);
|
|
|
|
struct spa_fraction framerate = SPA_FRACTION(0, 1);
|
|
|
|
|
|
|
|
return (const struct spa_pod *) spa_pod_builder_add_object(builder,
|
|
|
|
SPA_TYPE_OBJECT_Format, SPA_PARAM_EnumFormat,
|
|
|
|
SPA_FORMAT_mediaType, SPA_POD_Id(SPA_MEDIA_TYPE_video),
|
|
|
|
SPA_FORMAT_mediaSubtype, SPA_POD_Id(SPA_MEDIA_SUBTYPE_raw),
|
|
|
|
SPA_FORMAT_VIDEO_format, SPA_POD_Id(SPA_VIDEO_FORMAT_BGRx),
|
|
|
|
SPA_FORMAT_VIDEO_size, SPA_POD_Rectangle(&size),
|
|
|
|
SPA_FORMAT_VIDEO_framerate, SPA_POD_Fraction(&framerate));
|
|
|
|
}
|
|
|
|
|
2021-07-28 09:41:36 +00:00
|
|
|
static void request_buffer(struct pipewire_state *state)
|
|
|
|
{
|
|
|
|
struct pw_buffer *pw_buffer = pw_stream_dequeue_buffer(state->stream);
|
|
|
|
if (!pw_buffer) {
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf("warning: out of buffers");
|
2021-07-28 12:55:00 +00:00
|
|
|
state->needs_buffer = true;
|
2021-07-28 09:41:36 +00:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
struct spa_buffer *spa_buffer = pw_buffer->buffer;
|
|
|
|
uint8_t *data = (uint8_t *) spa_buffer->datas[0].data;
|
|
|
|
assert(data != nullptr);
|
|
|
|
|
|
|
|
struct spa_meta_header *header = (struct spa_meta_header *) spa_buffer_find_meta_data(spa_buffer, SPA_META_Header, sizeof(*header));
|
|
|
|
if (header != nullptr) {
|
|
|
|
header->pts = -1;
|
|
|
|
header->flags = 0;
|
|
|
|
header->seq = state->seq++;
|
|
|
|
header->dts_offset = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
struct spa_chunk *chunk = spa_buffer->datas[0].chunk;
|
|
|
|
chunk->offset = 0;
|
|
|
|
chunk->size = state->video_info.size.height * state->stride;
|
|
|
|
chunk->stride = state->stride;
|
|
|
|
|
|
|
|
struct pipewire_buffer *buffer = new pipewire_buffer();
|
|
|
|
buffer->buffer = pw_buffer;
|
|
|
|
buffer->video_info = state->video_info;
|
|
|
|
buffer->stride = state->stride;
|
|
|
|
buffer->data = data;
|
|
|
|
|
|
|
|
struct pipewire_buffer *old = out_buffer.exchange(buffer);
|
|
|
|
assert(old == nullptr);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void dispatch_nudge(struct pipewire_state *state, int fd)
|
|
|
|
{
|
|
|
|
while (true) {
|
|
|
|
static char buf[1024];
|
|
|
|
if (read(fd, buf, sizeof(buf)) < 0) {
|
|
|
|
if (errno != EAGAIN)
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf_errno("dispatch_nudge: read failed");
|
2021-07-28 09:41:36 +00:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-07-28 10:26:39 +00:00
|
|
|
if (g_nOutputWidth != state->video_info.size.width || g_nOutputHeight != state->video_info.size.height) {
|
2021-08-31 15:03:55 +00:00
|
|
|
log.debugf("renegociating stream params (size: %dx%d)", g_nOutputWidth, g_nOutputHeight);
|
2021-07-28 10:26:39 +00:00
|
|
|
|
|
|
|
uint8_t buf[1024];
|
|
|
|
struct spa_pod_builder builder = SPA_POD_BUILDER_INIT(buf, sizeof(buf));
|
|
|
|
const struct spa_pod *format_param = get_format_param(&builder);
|
|
|
|
int ret = pw_stream_update_params(state->stream, &format_param, 1);
|
|
|
|
if (ret < 0) {
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf("pw_stream_update_params failed");
|
2021-07-28 10:26:39 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-07-28 09:41:36 +00:00
|
|
|
struct pipewire_buffer *buffer = in_buffer.exchange(nullptr);
|
|
|
|
if (buffer != nullptr) {
|
|
|
|
pw_stream_queue_buffer(state->stream, buffer->buffer);
|
|
|
|
delete buffer;
|
|
|
|
|
|
|
|
if (state->streaming) {
|
|
|
|
request_buffer(state);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-07-27 16:01:04 +00:00
|
|
|
static void stream_handle_state_changed(void *data, enum pw_stream_state old_stream_state, enum pw_stream_state stream_state, const char *error)
|
|
|
|
{
|
|
|
|
struct pipewire_state *state = (struct pipewire_state *) data;
|
|
|
|
|
2021-08-31 15:03:55 +00:00
|
|
|
log.debugf("stream state changed: %s", pw_stream_state_as_string(stream_state));
|
2021-07-27 16:01:04 +00:00
|
|
|
|
|
|
|
switch (stream_state) {
|
|
|
|
case PW_STREAM_STATE_PAUSED:
|
|
|
|
if (state->stream_node_id == SPA_ID_INVALID) {
|
|
|
|
state->stream_node_id = pw_stream_get_node_id(state->stream);
|
|
|
|
}
|
2021-07-27 18:41:31 +00:00
|
|
|
state->streaming = false;
|
2021-07-28 09:41:36 +00:00
|
|
|
state->seq = 0;
|
2021-07-27 16:01:04 +00:00
|
|
|
break;
|
|
|
|
case PW_STREAM_STATE_STREAMING:
|
2021-07-27 18:41:31 +00:00
|
|
|
state->streaming = true;
|
2021-07-28 09:41:36 +00:00
|
|
|
request_buffer(state);
|
2021-07-27 18:41:31 +00:00
|
|
|
break;
|
|
|
|
case PW_STREAM_STATE_ERROR:
|
|
|
|
case PW_STREAM_STATE_UNCONNECTED:
|
|
|
|
state->running = false;
|
2021-07-27 16:01:04 +00:00
|
|
|
break;
|
|
|
|
default:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-07-27 18:41:31 +00:00
|
|
|
static void stream_handle_param_changed(void *data, uint32_t id, const struct spa_pod *param)
|
|
|
|
{
|
|
|
|
struct pipewire_state *state = (struct pipewire_state *) data;
|
|
|
|
|
|
|
|
if (param == nullptr || id != SPA_PARAM_Format)
|
|
|
|
return;
|
|
|
|
|
2021-07-28 09:41:36 +00:00
|
|
|
int bpp = 4;
|
2021-07-27 18:41:31 +00:00
|
|
|
int ret = spa_format_video_raw_parse(param, &state->video_info);
|
|
|
|
if (ret < 0) {
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf("spa_format_video_raw_parse failed");
|
2021-07-27 18:41:31 +00:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
state->stride = SPA_ROUND_UP_N(state->video_info.size.width * bpp, 4);
|
|
|
|
|
2021-08-31 15:03:55 +00:00
|
|
|
log.debugf("format changed (size: %dx%d)", state->video_info.size.width, state->video_info.size.height);
|
2021-07-28 10:26:39 +00:00
|
|
|
|
2021-07-27 18:41:31 +00:00
|
|
|
uint8_t buf[1024];
|
|
|
|
struct spa_pod_builder builder = SPA_POD_BUILDER_INIT(buf, sizeof(buf));
|
|
|
|
|
2021-07-28 09:41:36 +00:00
|
|
|
int buffers = 4;
|
|
|
|
int size = state->stride * state->video_info.size.height;
|
2021-07-27 18:41:31 +00:00
|
|
|
int data_type = 1 << SPA_DATA_MemPtr;
|
|
|
|
|
|
|
|
const struct spa_pod *buffers_param =
|
|
|
|
(const struct spa_pod *) spa_pod_builder_add_object(&builder,
|
|
|
|
SPA_TYPE_OBJECT_ParamBuffers, SPA_PARAM_Buffers,
|
|
|
|
SPA_PARAM_BUFFERS_buffers, SPA_POD_CHOICE_RANGE_Int(buffers, 1, 32),
|
|
|
|
SPA_PARAM_BUFFERS_blocks, SPA_POD_Int(1),
|
2021-07-28 09:41:36 +00:00
|
|
|
SPA_PARAM_BUFFERS_size, SPA_POD_Int(size),
|
2021-07-27 18:41:31 +00:00
|
|
|
SPA_PARAM_BUFFERS_stride, SPA_POD_Int(state->stride),
|
|
|
|
SPA_PARAM_BUFFERS_dataType, SPA_POD_CHOICE_FLAGS_Int(data_type));
|
|
|
|
const struct spa_pod *meta_param =
|
|
|
|
(const struct spa_pod *) spa_pod_builder_add_object(&builder,
|
|
|
|
SPA_TYPE_OBJECT_ParamMeta, SPA_PARAM_Meta,
|
|
|
|
SPA_PARAM_META_type, SPA_POD_Id(SPA_META_Header),
|
|
|
|
SPA_PARAM_META_size, SPA_POD_Int(sizeof(struct spa_meta_header)));
|
|
|
|
const struct spa_pod *params[] = { buffers_param, meta_param };
|
|
|
|
|
|
|
|
ret = pw_stream_update_params(state->stream, params, sizeof(params) / sizeof(params[0]));
|
|
|
|
if (ret != 0) {
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf("pw_stream_update_params failed");
|
2021-07-27 18:41:31 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-07-28 12:55:00 +00:00
|
|
|
static void stream_handle_process(void *data)
|
|
|
|
{
|
|
|
|
struct pipewire_state *state = (struct pipewire_state *) data;
|
|
|
|
|
|
|
|
if (state->needs_buffer) {
|
|
|
|
state->needs_buffer = false;
|
|
|
|
request_buffer(state);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-07-27 16:01:04 +00:00
|
|
|
static const struct pw_stream_events stream_events = {
|
|
|
|
.version = PW_VERSION_STREAM_EVENTS,
|
|
|
|
.state_changed = stream_handle_state_changed,
|
2021-07-27 18:41:31 +00:00
|
|
|
.param_changed = stream_handle_param_changed,
|
2021-07-28 12:55:00 +00:00
|
|
|
.process = stream_handle_process,
|
2021-07-27 16:01:04 +00:00
|
|
|
//.add_buffer = stream_handle_add_buffer,
|
|
|
|
//.remove_buffer = stream_handle_remove_buffer,
|
|
|
|
};
|
|
|
|
|
2021-07-28 09:41:36 +00:00
|
|
|
enum event_type {
|
|
|
|
EVENT_PIPEWIRE,
|
|
|
|
EVENT_NUDGE,
|
|
|
|
EVENT_COUNT // keep last
|
|
|
|
};
|
|
|
|
|
2021-07-27 18:41:31 +00:00
|
|
|
static void run_pipewire(struct pipewire_state *state)
|
|
|
|
{
|
2021-07-28 09:41:36 +00:00
|
|
|
struct pollfd pollfds[] = {
|
|
|
|
[EVENT_PIPEWIRE] = {
|
|
|
|
.fd = pw_loop_get_fd(state->loop),
|
|
|
|
.events = POLLIN,
|
|
|
|
},
|
|
|
|
[EVENT_NUDGE] = {
|
|
|
|
.fd = nudgePipe[0],
|
|
|
|
.events = POLLIN,
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
2021-07-27 18:41:31 +00:00
|
|
|
state->running = true;
|
|
|
|
while (state->running) {
|
2021-07-28 09:41:36 +00:00
|
|
|
int ret = poll(pollfds, EVENT_COUNT, -1);
|
2021-07-27 18:41:31 +00:00
|
|
|
if (ret < 0) {
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf_errno("poll failed");
|
2021-07-27 18:41:31 +00:00
|
|
|
break;
|
|
|
|
}
|
2021-07-28 09:41:36 +00:00
|
|
|
|
|
|
|
if (pollfds[EVENT_PIPEWIRE].revents & POLLHUP) {
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf("lost connection to server");
|
2021-07-28 09:41:36 +00:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
assert(!(pollfds[EVENT_NUDGE].revents & POLLHUP));
|
|
|
|
|
|
|
|
if (pollfds[EVENT_PIPEWIRE].revents & POLLIN) {
|
|
|
|
ret = pw_loop_iterate(state->loop, -1);
|
|
|
|
if (ret < 0) {
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf("pw_loop_iterate failed");
|
2021-07-28 09:41:36 +00:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (pollfds[EVENT_NUDGE].revents & POLLIN) {
|
|
|
|
dispatch_nudge(state, nudgePipe[0]);
|
|
|
|
}
|
2021-07-27 18:41:31 +00:00
|
|
|
}
|
|
|
|
|
2021-08-31 15:03:55 +00:00
|
|
|
log.infof("exiting");
|
2021-07-27 18:41:31 +00:00
|
|
|
pw_stream_destroy(state->stream);
|
|
|
|
pw_core_disconnect(state->core);
|
|
|
|
pw_context_destroy(state->context);
|
|
|
|
pw_loop_destroy(state->loop);
|
|
|
|
}
|
|
|
|
|
2021-07-27 16:01:04 +00:00
|
|
|
bool init_pipewire(void)
|
|
|
|
{
|
2021-07-29 08:09:10 +00:00
|
|
|
struct pipewire_state *state = &pipewire_state;
|
2021-07-27 16:01:04 +00:00
|
|
|
|
2021-07-29 08:09:10 +00:00
|
|
|
pw_init(nullptr, nullptr);
|
2021-07-27 16:01:04 +00:00
|
|
|
|
2021-07-28 09:41:36 +00:00
|
|
|
if (pipe2(nudgePipe, O_CLOEXEC | O_NONBLOCK) != 0) {
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf_errno("pipe2 failed");
|
2021-07-28 09:41:36 +00:00
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2021-07-29 08:09:10 +00:00
|
|
|
state->loop = pw_loop_new(nullptr);
|
|
|
|
if (!state->loop) {
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf("pw_loop_new failed");
|
2021-07-27 16:01:04 +00:00
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2021-07-29 08:09:10 +00:00
|
|
|
state->context = pw_context_new(state->loop, nullptr, 0);
|
|
|
|
if (!state->context) {
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf("pw_context_new failed");
|
2021-07-27 16:01:04 +00:00
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2021-07-29 08:09:10 +00:00
|
|
|
state->core = pw_context_connect(state->context, nullptr, 0);
|
|
|
|
if (!state->core) {
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf("pw_context_connect failed");
|
2021-07-27 16:01:04 +00:00
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2021-07-29 08:09:10 +00:00
|
|
|
state->stream = pw_stream_new(state->core, "gamescope",
|
2021-07-27 16:01:04 +00:00
|
|
|
pw_properties_new(
|
|
|
|
PW_KEY_MEDIA_CLASS, "Video/Source",
|
|
|
|
nullptr));
|
2021-07-29 08:09:10 +00:00
|
|
|
if (!state->stream) {
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf("pw_stream_new failed");
|
2021-07-27 16:01:04 +00:00
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2021-07-27 18:41:31 +00:00
|
|
|
static struct spa_hook stream_hook;
|
2021-07-29 08:09:10 +00:00
|
|
|
pw_stream_add_listener(state->stream, &stream_hook, &stream_events, state);
|
2021-07-27 16:01:04 +00:00
|
|
|
|
|
|
|
uint8_t buf[1024];
|
|
|
|
struct spa_pod_builder builder = SPA_POD_BUILDER_INIT(buf, sizeof(buf));
|
2021-07-28 10:26:39 +00:00
|
|
|
const struct spa_pod *format_param = get_format_param(&builder);
|
2021-07-27 16:01:04 +00:00
|
|
|
|
|
|
|
// TODO: PW_STREAM_FLAG_ALLOC_BUFFERS
|
2021-07-28 09:41:36 +00:00
|
|
|
enum pw_stream_flags flags = (enum pw_stream_flags)(PW_STREAM_FLAG_DRIVER | PW_STREAM_FLAG_MAP_BUFFERS);
|
2021-07-29 08:09:10 +00:00
|
|
|
int ret = pw_stream_connect(state->stream, PW_DIRECTION_OUTPUT, PW_ID_ANY, flags, &format_param, 1);
|
2021-07-27 16:01:04 +00:00
|
|
|
if (ret != 0) {
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf("pw_stream_connect failed");
|
2021-07-27 16:01:04 +00:00
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2021-07-29 08:09:10 +00:00
|
|
|
while (state->stream_node_id == SPA_ID_INVALID) {
|
|
|
|
int ret = pw_loop_iterate(state->loop, -1);
|
2021-07-27 16:01:04 +00:00
|
|
|
if (ret < 0) {
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf("pw_loop_iterate failed");
|
2021-07-27 16:01:04 +00:00
|
|
|
return false;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-08-31 15:03:55 +00:00
|
|
|
log.infof("stream available on node ID: %u", state->stream_node_id);
|
2021-07-27 16:01:04 +00:00
|
|
|
|
2021-07-29 08:09:10 +00:00
|
|
|
std::thread thread(run_pipewire, state);
|
2021-07-27 18:41:31 +00:00
|
|
|
thread.detach();
|
|
|
|
|
2021-07-27 16:01:04 +00:00
|
|
|
return true;
|
|
|
|
}
|
2021-07-28 09:41:36 +00:00
|
|
|
|
2021-07-29 08:09:10 +00:00
|
|
|
uint32_t get_pipewire_stream_node_id(void)
|
|
|
|
{
|
|
|
|
return pipewire_state.stream_node_id;
|
|
|
|
}
|
|
|
|
|
2021-07-28 09:41:36 +00:00
|
|
|
struct pipewire_buffer *dequeue_pipewire_buffer(void)
|
|
|
|
{
|
|
|
|
return out_buffer.exchange(nullptr);
|
|
|
|
}
|
|
|
|
|
|
|
|
void push_pipewire_buffer(struct pipewire_buffer *buffer)
|
|
|
|
{
|
|
|
|
struct pipewire_buffer *old = in_buffer.exchange(buffer);
|
|
|
|
assert(old == nullptr);
|
2021-07-28 10:26:39 +00:00
|
|
|
nudge_pipewire();
|
|
|
|
}
|
2021-07-28 09:41:36 +00:00
|
|
|
|
2021-07-28 10:26:39 +00:00
|
|
|
void nudge_pipewire(void)
|
|
|
|
{
|
2021-07-28 09:41:36 +00:00
|
|
|
if (write(nudgePipe[1], "\n", 1) < 0)
|
2021-08-31 15:03:55 +00:00
|
|
|
log.errorf_errno("nudge_pipewire: write failed");
|
2021-07-28 09:41:36 +00:00
|
|
|
}
|