Refactor a2dp thread execution flow and improve time estimation

This commit is contained in:
João Paulo Rechi Vita 2008-08-19 16:06:21 -03:00 committed by Lennart Poettering
parent 2f455bfa5a
commit e570767896

View file

@ -30,10 +30,11 @@
#include <pulse/xmalloc.h> #include <pulse/xmalloc.h>
#include <pulse/timeval.h> #include <pulse/timeval.h>
#include <pulse/sample.h> #include <pulse/sample.h>
#include <pulsecore/core-util.h>
#include <pulsecore/core-error.h>
#include <pulsecore/module.h> #include <pulsecore/module.h>
#include <pulsecore/modargs.h> #include <pulsecore/modargs.h>
#include <pulsecore/core-util.h>
#include <pulsecore/core-error.h>
#include <pulsecore/socket-util.h>
#include <pulsecore/thread.h> #include <pulsecore/thread.h>
#include <pulsecore/thread-mq.h> #include <pulsecore/thread-mq.h>
#include <pulsecore/rtpoll.h> #include <pulsecore/rtpoll.h>
@ -505,20 +506,20 @@ static int bt_getstreamfd(struct userdata *u) {
return -errno; return -errno;
} }
// if (u->transport == BT_CAPABILITIES_TRANSPORT_A2DP) { if (u->transport == BT_CAPABILITIES_TRANSPORT_A2DP) {
// if (setsockopt(u->stream_fd, SOL_SOCKET, SO_SNDTIMEO, &t, sizeof(t)) < 0) { if (pa_socket_set_sndbuf(u->stream_fd, 10*u->link_mtu) < 0) {
// pa_log_error("failed to set socket options for A2DP: %s (%d)",pa_cstrerror(errno), errno); pa_log_error("failed to set socket options for A2DP: %s (%d)",pa_cstrerror(errno), errno);
// return -errno; return -errno;
// } }
// } }
// else {
// if (setsockopt(u->stream_fd, SOL_SCO, SCO_TXBUFS, &period_count, sizeof(period_count)) == 0) // if (setsockopt(u->stream_fd, SOL_SCO, SCO_TXBUFS, &period_count, sizeof(period_count)) == 0)
// return 0; // return 0;
// if (setsockopt(u->stream_fd, SOL_SCO, SO_SNDBUF, &period_count, sizeof(period_count)) == 0) // if (setsockopt(u->stream_fd, SOL_SCO, SO_SNDBUF, &period_count, sizeof(period_count)) == 0)
// return 0; // return 0;
// /* FIXME : handle error codes */ // /* FIXME : handle error codes */
// }
pa_make_fd_nonblock(u->stream_fd); pa_make_fd_nonblock(u->stream_fd);
// pa_make_socket_low_delay(u->stream_fd);
return 0; return 0;
} }
@ -692,11 +693,10 @@ finish:
static void a2dp_thread_func(void *userdata) { static void a2dp_thread_func(void *userdata) {
struct userdata *u = userdata; struct userdata *u = userdata;
int write_type = 0;
pa_assert(u); pa_assert(u);
pa_log/*_debug*/("A2DP Thread starting up"); pa_log_debug("A2DP Thread starting up");
pa_thread_mq_install(&u->thread_mq); pa_thread_mq_install(&u->thread_mq);
pa_rtpoll_install(u->rtpoll); pa_rtpoll_install(u->rtpoll);
@ -709,127 +709,107 @@ static void a2dp_thread_func(void *userdata) {
if (PA_SINK_IS_OPENED(u->sink->thread_info.state)) { if (PA_SINK_IS_OPENED(u->sink->thread_info.state)) {
if (u->sink->thread_info.rewind_requested) { if (u->sink->thread_info.rewind_requested) {
pa_log("rewind_requested");
pa_sink_process_rewind(u->sink, 0); pa_sink_process_rewind(u->sink, 0);
pa_log("rewind_finished");
} }
} }
pollfd = pa_rtpoll_item_get_pollfd(u->rtpoll_item, NULL); pollfd = pa_rtpoll_item_get_pollfd(u->rtpoll_item, NULL);
/* Render some data and write it to the fifo */
if (PA_SINK_IS_OPENED(u->sink->thread_info.state) && pollfd->revents) { if (PA_SINK_IS_OPENED(u->sink->thread_info.state) && pollfd->revents) {
pa_usec_t usec; pa_usec_t usec;
int64_t n; int64_t n;
pa_log("Render some data and write it to the fifo"); ssize_t l;
int write_type = 0, written;
struct bt_a2dp *a2dp = &u->a2dp;
struct rtp_header *header = (void *) a2dp->buffer;
struct rtp_payload *payload = (void *) (a2dp->buffer + sizeof(*header));
for (;;) { do {
ssize_t l; /* Render some data */
void *p; void *p;
struct bt_a2dp *a2dp = &u->a2dp; int frame_size, encoded;
int frame_size, encoded, written;
u->memchunk.memblock = pa_memblock_new(u->mempool, u->block_size); u->memchunk.memblock = pa_memblock_new(u->mempool, u->block_size);
pa_log("memblock allocated %d", u->block_size); pa_log_debug("memblock asked size%d", u->block_size);
u->memchunk.length = pa_memblock_get_length(u->memchunk.memblock); u->memchunk.length = pa_memblock_get_length(u->memchunk.memblock);
pa_log("memchunk length %d", u->memchunk.length); pa_log_debug("memchunk length %d", u->memchunk.length);
pa_sink_render_into_full(u->sink, &u->memchunk); pa_sink_render_into_full(u->sink, &u->memchunk);
pa_log("rendered"); pa_log_debug("rendered");
pa_assert(u->memchunk.length > 0); pa_assert(u->memchunk.length > 0);
p = pa_memblock_acquire(u->memchunk.memblock); p = pa_memblock_acquire(u->memchunk.memblock);
pa_log("memblock acquired");
frame_size = sbc_get_frame_length(&a2dp->sbc); frame_size = sbc_get_frame_length(&a2dp->sbc);
pa_log("frame_size: %d", frame_size); pa_log_debug("frame_size: %d", frame_size);
encoded = sbc_encode(&a2dp->sbc, (uint8_t*) p, a2dp->codesize, a2dp->buffer + a2dp->count, encoded = sbc_encode(&a2dp->sbc, (uint8_t*) p, a2dp->codesize, a2dp->buffer + a2dp->count,
sizeof(a2dp->buffer) - a2dp->count, &written); sizeof(a2dp->buffer) - a2dp->count, &written);
pa_log("encoded: %d", encoded); pa_log_debug("encoded: %d", encoded);
pa_log("written: %d", encoded); pa_log_debug("written: %d", written);
if (encoded <= 0) { if (encoded <= 0) {
pa_log_error("SBC encoding error (%d)", encoded); pa_log_error("SBC encoding error (%d)", encoded);
goto fail; goto fail;
} }
pa_memblock_release(u->memchunk.memblock); pa_memblock_release(u->memchunk.memblock);
pa_log("memblock released");
pa_memblock_unref(u->memchunk.memblock); pa_memblock_unref(u->memchunk.memblock);
pa_log("memblock unrefered");
pa_memchunk_reset(&u->memchunk); pa_memchunk_reset(&u->memchunk);
pa_log("memchunk reseted"); pa_log_debug("memchunk reseted");
a2dp->count += written; a2dp->count += written;
a2dp->frame_count++; a2dp->frame_count++;
a2dp->samples += encoded / frame_size; a2dp->samples += encoded / frame_size;
a2dp->nsamples += encoded / frame_size; a2dp->nsamples += encoded / frame_size;
if (a2dp->count + written >= u->link_mtu) { } while (a2dp->count + written <= u->link_mtu);
struct rtp_header *header = (void *) a2dp->buffer;
struct rtp_payload *payload = (void *) (a2dp->buffer + sizeof(*header));
memset(a2dp->buffer, 0, sizeof(*header) + sizeof(*payload)); /* write it to the fifo */
memset(a2dp->buffer, 0, sizeof(*header) + sizeof(*payload));
payload->frame_count = a2dp->frame_count;
header->v = 2;
header->pt = 1;
header->sequence_number = htons(a2dp->seq_num);
header->timestamp = htonl(a2dp->nsamples);
header->ssrc = htonl(1);
payload->frame_count = a2dp->frame_count; avdtp_write:
header->v = 2; l = pa_write(u->stream_fd, a2dp->buffer, a2dp->count, write_type);
header->pt = 1; pa_log_debug("avdtp_write: requested %d bytes; written %d bytes", a2dp->count, l);
header->sequence_number = htons(a2dp->seq_num);
header->timestamp = htonl(a2dp->nsamples);
header->ssrc = htonl(1);
l = pa_write(u->stream_fd, a2dp->buffer, a2dp->count, 0); pa_assert(l != 0);
pa_log("avdtp_write %d", a2dp->count);
if (l > 0) { if (l < 0) {
/* Reset buffer of data to send */ if (errno == EINTR) {
a2dp->count = sizeof(struct rtp_header) + sizeof(struct rtp_payload); pa_log_debug("EINTR");
a2dp->frame_count = 0; continue;
a2dp->samples = 0; }
a2dp->seq_num++; else if (errno == EAGAIN) {
} pa_log_debug("EAGAIN");
goto avdtp_write;
pa_log("avdtp written %d bytes", l); }
else {
pa_assert(l != 0); pa_log_error("Failed to write data to FIFO: %s", pa_cstrerror(errno));
goto fail;
if (l < 0) {
pa_log("l = %d < 0", l);
if (errno == EINTR) {
pa_log("EINTR");
continue;
}
else if (errno == EAGAIN) {
pa_log("EAGAIN");
goto filled_up;
}
else {
pa_log("Failed to write data to FIFO: %s", pa_cstrerror(errno));
goto fail;
}
} else {
pa_log("l = %d >= 0", l);
u->offset += l;
pollfd->revents = 0;
goto filled_up;
}
} }
} }
filled_up: u->offset += a2dp->codesize*a2dp->frame_count;
pollfd->revents = 0;
pa_log("filled_up"); /* Reset buffer of data to send */
/* At this spot we know that the socket buffers are fully filled up. a2dp->count = sizeof(struct rtp_header) + sizeof(struct rtp_payload);
* This is the best time to estimate the playback position of the server */ a2dp->frame_count = 0;
a2dp->samples = 0;
a2dp->seq_num++;
/* feed the time smoother */
n = u->offset; n = u->offset;
#ifdef SIOCOUTQ #ifdef SIOCOUTQ
{ {
int l; int ll;
if (ioctl(u->fd, SIOCOUTQ, &l) >= 0 && l > 0) if (ioctl(u->fd, SIOCOUTQ, &ll) >= 0 && ll > 0)
n -= l; n -= ll;
} }
#endif #endif
usec = pa_bytes_to_usec(n, &u->sink->sample_spec); usec = pa_bytes_to_usec(n, &u->sink->sample_spec);
if (usec > u->latency) if (usec > u->latency)
usec -= u->latency; usec -= u->latency;
@ -839,35 +819,34 @@ filled_up:
} }
/* Hmm, nothing to do. Let's sleep */ /* Hmm, nothing to do. Let's sleep */
pa_log("let's sleep"); pa_log_debug("A2DP thread going to sleep");
pollfd->events = PA_SINK_IS_OPENED(u->sink->thread_info.state) ? POLLOUT : 0; pollfd->events = PA_SINK_IS_OPENED(u->sink->thread_info.state) ? POLLOUT : 0;
if ((ret = pa_rtpoll_run(u->rtpoll, TRUE)) < 0) { if ((ret = pa_rtpoll_run(u->rtpoll, TRUE)) < 0) {
pa_log("ret < 0"); pa_log("ret < 0");
goto fail; goto fail;
} }
pa_log("waking up"); pa_log_debug("A2DP thread waking up");
if (ret == 0) { if (ret == 0) {
pa_log("ret == 0"); pa_log_warn("ret == 0");
goto finish; goto finish;
} }
pollfd = pa_rtpoll_item_get_pollfd(u->rtpoll_item, NULL); pollfd = pa_rtpoll_item_get_pollfd(u->rtpoll_item, NULL);
if (pollfd->revents & ~POLLOUT) { if (pollfd->revents & ~POLLOUT) {
pa_log("FIFO shutdown."); pa_log_error("FIFO shutdown.");
goto fail; goto fail;
} }
} }
fail: fail:
/* If this was no regular exit from the loop we have to continue processing messages until we receive PA_MESSAGE_SHUTDOWN */ /* If this was no regular exit from the loop we have to continue processing messages until we receive PA_MESSAGE_SHUTDOWN */
pa_log("fail"); pa_log_debug("A2DP thread failed");
pa_asyncmsgq_post(u->thread_mq.outq, PA_MSGOBJECT(u->core), PA_CORE_MESSAGE_UNLOAD_MODULE, u->module, 0, NULL, NULL); pa_asyncmsgq_post(u->thread_mq.outq, PA_MSGOBJECT(u->core), PA_CORE_MESSAGE_UNLOAD_MODULE, u->module, 0, NULL, NULL);
pa_asyncmsgq_wait_for(u->thread_mq.inq, PA_MESSAGE_SHUTDOWN); pa_asyncmsgq_wait_for(u->thread_mq.inq, PA_MESSAGE_SHUTDOWN);
finish: finish:
pa_log_debug("A2DP Thread shutting down"); pa_log_debug("A2DP thread shutting down");
} }
int pa__init(pa_module* m) { int pa__init(pa_module* m) {