153a5a1b3Sopenharmony_ci/***
253a5a1b3Sopenharmony_ci  This file is part of PulseAudio.
353a5a1b3Sopenharmony_ci
453a5a1b3Sopenharmony_ci  Copyright 2009 Lennart Poettering
553a5a1b3Sopenharmony_ci
653a5a1b3Sopenharmony_ci  PulseAudio is free software; you can redistribute it and/or modify
753a5a1b3Sopenharmony_ci  it under the terms of the GNU Lesser General Public License as
853a5a1b3Sopenharmony_ci  published by the Free Software Foundation; either version 2.1 of the
953a5a1b3Sopenharmony_ci  License, or (at your option) any later version.
1053a5a1b3Sopenharmony_ci
1153a5a1b3Sopenharmony_ci  PulseAudio is distributed in the hope that it will be useful, but
1253a5a1b3Sopenharmony_ci  WITHOUT ANY WARRANTY; without even the implied warranty of
1353a5a1b3Sopenharmony_ci  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
1453a5a1b3Sopenharmony_ci  General Public License for more details.
1553a5a1b3Sopenharmony_ci
1653a5a1b3Sopenharmony_ci  You should have received a copy of the GNU Lesser General Public
1753a5a1b3Sopenharmony_ci  License along with PulseAudio; if not, see <http://www.gnu.org/licenses/>.
1853a5a1b3Sopenharmony_ci***/
1953a5a1b3Sopenharmony_ci
2053a5a1b3Sopenharmony_ci#ifdef HAVE_CONFIG_H
2153a5a1b3Sopenharmony_ci#include <config.h>
2253a5a1b3Sopenharmony_ci#endif
2353a5a1b3Sopenharmony_ci
2453a5a1b3Sopenharmony_ci#include <signal.h>
2553a5a1b3Sopenharmony_ci
2653a5a1b3Sopenharmony_ci#ifdef HAVE_SYS_MMAN_H
2753a5a1b3Sopenharmony_ci#include <sys/mman.h>
2853a5a1b3Sopenharmony_ci#endif
2953a5a1b3Sopenharmony_ci
3053a5a1b3Sopenharmony_ci/* This is deprecated on glibc but is still used by FreeBSD */
3153a5a1b3Sopenharmony_ci#if !defined(MAP_ANONYMOUS) && defined(MAP_ANON)
3253a5a1b3Sopenharmony_ci# define MAP_ANONYMOUS MAP_ANON
3353a5a1b3Sopenharmony_ci#endif
3453a5a1b3Sopenharmony_ci
3553a5a1b3Sopenharmony_ci#include <pulse/xmalloc.h>
3653a5a1b3Sopenharmony_ci
3753a5a1b3Sopenharmony_ci#include <pulsecore/core-util.h>
3853a5a1b3Sopenharmony_ci#include <pulsecore/aupdate.h>
3953a5a1b3Sopenharmony_ci#include <pulsecore/atomic.h>
4053a5a1b3Sopenharmony_ci#include <pulsecore/once.h>
4153a5a1b3Sopenharmony_ci#include <pulsecore/mutex.h>
4253a5a1b3Sopenharmony_ci
4353a5a1b3Sopenharmony_ci#include "memtrap.h"
4453a5a1b3Sopenharmony_ci
4553a5a1b3Sopenharmony_cistruct pa_memtrap {
4653a5a1b3Sopenharmony_ci    void *start;
4753a5a1b3Sopenharmony_ci    size_t size;
4853a5a1b3Sopenharmony_ci    pa_atomic_t bad;
4953a5a1b3Sopenharmony_ci    pa_memtrap *next[2], *prev[2];
5053a5a1b3Sopenharmony_ci};
5153a5a1b3Sopenharmony_ci
5253a5a1b3Sopenharmony_cistatic pa_memtrap *memtraps[2] = { NULL, NULL };
5353a5a1b3Sopenharmony_cistatic pa_aupdate *aupdate;
5453a5a1b3Sopenharmony_cistatic pa_static_mutex mutex = PA_STATIC_MUTEX_INIT; /* only required to serialize access to the write side */
5553a5a1b3Sopenharmony_ci
5653a5a1b3Sopenharmony_cistatic void allocate_aupdate(void) {
5753a5a1b3Sopenharmony_ci    PA_ONCE_BEGIN {
5853a5a1b3Sopenharmony_ci        aupdate = pa_aupdate_new();
5953a5a1b3Sopenharmony_ci    } PA_ONCE_END;
6053a5a1b3Sopenharmony_ci}
6153a5a1b3Sopenharmony_ci
6253a5a1b3Sopenharmony_cibool pa_memtrap_is_good(pa_memtrap *m) {
6353a5a1b3Sopenharmony_ci    pa_assert(m);
6453a5a1b3Sopenharmony_ci
6553a5a1b3Sopenharmony_ci    return !pa_atomic_load(&m->bad);
6653a5a1b3Sopenharmony_ci}
6753a5a1b3Sopenharmony_ci
6853a5a1b3Sopenharmony_ci#ifdef HAVE_SIGACTION
6953a5a1b3Sopenharmony_cistatic void sigsafe_error(const char *s) {
7053a5a1b3Sopenharmony_ci    size_t ret PA_GCC_UNUSED;
7153a5a1b3Sopenharmony_ci    ret = write(STDERR_FILENO, s, strlen(s));
7253a5a1b3Sopenharmony_ci}
7353a5a1b3Sopenharmony_ci
7453a5a1b3Sopenharmony_cistatic void signal_handler(int sig, siginfo_t* si, void *data) {
7553a5a1b3Sopenharmony_ci    unsigned j;
7653a5a1b3Sopenharmony_ci    pa_memtrap *m;
7753a5a1b3Sopenharmony_ci    void *r;
7853a5a1b3Sopenharmony_ci
7953a5a1b3Sopenharmony_ci    j = pa_aupdate_read_begin(aupdate);
8053a5a1b3Sopenharmony_ci
8153a5a1b3Sopenharmony_ci    for (m = memtraps[j]; m; m = m->next[j])
8253a5a1b3Sopenharmony_ci        if (si->si_addr >= m->start &&
8353a5a1b3Sopenharmony_ci            (uint8_t*) si->si_addr < (uint8_t*) m->start + m->size)
8453a5a1b3Sopenharmony_ci            break;
8553a5a1b3Sopenharmony_ci
8653a5a1b3Sopenharmony_ci    if (!m)
8753a5a1b3Sopenharmony_ci        goto fail;
8853a5a1b3Sopenharmony_ci
8953a5a1b3Sopenharmony_ci    pa_atomic_store(&m->bad, 1);
9053a5a1b3Sopenharmony_ci
9153a5a1b3Sopenharmony_ci    /* Remap anonymous memory into the bad segment */
9253a5a1b3Sopenharmony_ci    if ((r = mmap(m->start, m->size, PROT_READ|PROT_WRITE, MAP_ANONYMOUS|MAP_FIXED|MAP_PRIVATE, -1, 0)) == MAP_FAILED) {
9353a5a1b3Sopenharmony_ci        sigsafe_error("mmap() failed.\n");
9453a5a1b3Sopenharmony_ci        goto fail;
9553a5a1b3Sopenharmony_ci    }
9653a5a1b3Sopenharmony_ci
9753a5a1b3Sopenharmony_ci    pa_assert(r == m->start);
9853a5a1b3Sopenharmony_ci
9953a5a1b3Sopenharmony_ci    pa_aupdate_read_end(aupdate);
10053a5a1b3Sopenharmony_ci    return;
10153a5a1b3Sopenharmony_ci
10253a5a1b3Sopenharmony_cifail:
10353a5a1b3Sopenharmony_ci    pa_aupdate_read_end(aupdate);
10453a5a1b3Sopenharmony_ci
10553a5a1b3Sopenharmony_ci    sigsafe_error("Failed to handle SIGBUS.\n");
10653a5a1b3Sopenharmony_ci    abort();
10753a5a1b3Sopenharmony_ci}
10853a5a1b3Sopenharmony_ci#endif
10953a5a1b3Sopenharmony_ci
11053a5a1b3Sopenharmony_cistatic void memtrap_link(pa_memtrap *m, unsigned j) {
11153a5a1b3Sopenharmony_ci    pa_assert(m);
11253a5a1b3Sopenharmony_ci
11353a5a1b3Sopenharmony_ci    m->prev[j] = NULL;
11453a5a1b3Sopenharmony_ci
11553a5a1b3Sopenharmony_ci    if ((m->next[j] = memtraps[j]))
11653a5a1b3Sopenharmony_ci        m->next[j]->prev[j] = m;
11753a5a1b3Sopenharmony_ci
11853a5a1b3Sopenharmony_ci    memtraps[j] = m;
11953a5a1b3Sopenharmony_ci}
12053a5a1b3Sopenharmony_ci
12153a5a1b3Sopenharmony_cistatic void memtrap_unlink(pa_memtrap *m, unsigned j) {
12253a5a1b3Sopenharmony_ci    pa_assert(m);
12353a5a1b3Sopenharmony_ci
12453a5a1b3Sopenharmony_ci    if (m->next[j])
12553a5a1b3Sopenharmony_ci        m->next[j]->prev[j] = m->prev[j];
12653a5a1b3Sopenharmony_ci
12753a5a1b3Sopenharmony_ci    if (m->prev[j])
12853a5a1b3Sopenharmony_ci        m->prev[j]->next[j] = m->next[j];
12953a5a1b3Sopenharmony_ci    else
13053a5a1b3Sopenharmony_ci        memtraps[j] = m->next[j];
13153a5a1b3Sopenharmony_ci}
13253a5a1b3Sopenharmony_ci
13353a5a1b3Sopenharmony_cipa_memtrap* pa_memtrap_add(const void *start, size_t size) {
13453a5a1b3Sopenharmony_ci    pa_memtrap *m = NULL;
13553a5a1b3Sopenharmony_ci    unsigned j;
13653a5a1b3Sopenharmony_ci    pa_mutex *mx;
13753a5a1b3Sopenharmony_ci
13853a5a1b3Sopenharmony_ci    pa_assert(start);
13953a5a1b3Sopenharmony_ci    pa_assert(size > 0);
14053a5a1b3Sopenharmony_ci
14153a5a1b3Sopenharmony_ci    start = PA_PAGE_ALIGN_PTR(start);
14253a5a1b3Sopenharmony_ci    size = PA_PAGE_ALIGN(size);
14353a5a1b3Sopenharmony_ci
14453a5a1b3Sopenharmony_ci    m = pa_xnew(pa_memtrap, 1);
14553a5a1b3Sopenharmony_ci    m->start = (void*) start;
14653a5a1b3Sopenharmony_ci    m->size = size;
14753a5a1b3Sopenharmony_ci    pa_atomic_store(&m->bad, 0);
14853a5a1b3Sopenharmony_ci
14953a5a1b3Sopenharmony_ci    allocate_aupdate();
15053a5a1b3Sopenharmony_ci
15153a5a1b3Sopenharmony_ci    mx = pa_static_mutex_get(&mutex, false, true);
15253a5a1b3Sopenharmony_ci    pa_mutex_lock(mx);
15353a5a1b3Sopenharmony_ci
15453a5a1b3Sopenharmony_ci    j = pa_aupdate_write_begin(aupdate);
15553a5a1b3Sopenharmony_ci    memtrap_link(m, j);
15653a5a1b3Sopenharmony_ci    j = pa_aupdate_write_swap(aupdate);
15753a5a1b3Sopenharmony_ci    memtrap_link(m, j);
15853a5a1b3Sopenharmony_ci    pa_aupdate_write_end(aupdate);
15953a5a1b3Sopenharmony_ci
16053a5a1b3Sopenharmony_ci    pa_mutex_unlock(mx);
16153a5a1b3Sopenharmony_ci
16253a5a1b3Sopenharmony_ci    return m;
16353a5a1b3Sopenharmony_ci}
16453a5a1b3Sopenharmony_ci
16553a5a1b3Sopenharmony_civoid pa_memtrap_remove(pa_memtrap *m) {
16653a5a1b3Sopenharmony_ci    unsigned j;
16753a5a1b3Sopenharmony_ci    pa_mutex *mx;
16853a5a1b3Sopenharmony_ci
16953a5a1b3Sopenharmony_ci    pa_assert(m);
17053a5a1b3Sopenharmony_ci
17153a5a1b3Sopenharmony_ci    allocate_aupdate();
17253a5a1b3Sopenharmony_ci
17353a5a1b3Sopenharmony_ci    mx = pa_static_mutex_get(&mutex, false, true);
17453a5a1b3Sopenharmony_ci    pa_mutex_lock(mx);
17553a5a1b3Sopenharmony_ci
17653a5a1b3Sopenharmony_ci    j = pa_aupdate_write_begin(aupdate);
17753a5a1b3Sopenharmony_ci    memtrap_unlink(m, j);
17853a5a1b3Sopenharmony_ci    j = pa_aupdate_write_swap(aupdate);
17953a5a1b3Sopenharmony_ci    memtrap_unlink(m, j);
18053a5a1b3Sopenharmony_ci    pa_aupdate_write_end(aupdate);
18153a5a1b3Sopenharmony_ci
18253a5a1b3Sopenharmony_ci    pa_mutex_unlock(mx);
18353a5a1b3Sopenharmony_ci
18453a5a1b3Sopenharmony_ci    pa_xfree(m);
18553a5a1b3Sopenharmony_ci}
18653a5a1b3Sopenharmony_ci
18753a5a1b3Sopenharmony_cipa_memtrap *pa_memtrap_update(pa_memtrap *m, const void *start, size_t size) {
18853a5a1b3Sopenharmony_ci    unsigned j;
18953a5a1b3Sopenharmony_ci    pa_mutex *mx;
19053a5a1b3Sopenharmony_ci
19153a5a1b3Sopenharmony_ci    pa_assert(m);
19253a5a1b3Sopenharmony_ci
19353a5a1b3Sopenharmony_ci    pa_assert(start);
19453a5a1b3Sopenharmony_ci    pa_assert(size > 0);
19553a5a1b3Sopenharmony_ci
19653a5a1b3Sopenharmony_ci    start = PA_PAGE_ALIGN_PTR(start);
19753a5a1b3Sopenharmony_ci    size = PA_PAGE_ALIGN(size);
19853a5a1b3Sopenharmony_ci
19953a5a1b3Sopenharmony_ci    allocate_aupdate();
20053a5a1b3Sopenharmony_ci
20153a5a1b3Sopenharmony_ci    mx = pa_static_mutex_get(&mutex, false, true);
20253a5a1b3Sopenharmony_ci    pa_mutex_lock(mx);
20353a5a1b3Sopenharmony_ci
20453a5a1b3Sopenharmony_ci    j = pa_aupdate_write_begin(aupdate);
20553a5a1b3Sopenharmony_ci
20653a5a1b3Sopenharmony_ci    if (m->start == start && m->size == size)
20753a5a1b3Sopenharmony_ci        goto unlock;
20853a5a1b3Sopenharmony_ci
20953a5a1b3Sopenharmony_ci    memtrap_unlink(m, j);
21053a5a1b3Sopenharmony_ci    pa_aupdate_write_swap(aupdate);
21153a5a1b3Sopenharmony_ci
21253a5a1b3Sopenharmony_ci    m->start = (void*) start;
21353a5a1b3Sopenharmony_ci    m->size = size;
21453a5a1b3Sopenharmony_ci    pa_atomic_store(&m->bad, 0);
21553a5a1b3Sopenharmony_ci
21653a5a1b3Sopenharmony_ci    pa_assert_se(pa_aupdate_write_swap(aupdate) == j);
21753a5a1b3Sopenharmony_ci    memtrap_link(m, j);
21853a5a1b3Sopenharmony_ci
21953a5a1b3Sopenharmony_ciunlock:
22053a5a1b3Sopenharmony_ci    pa_aupdate_write_end(aupdate);
22153a5a1b3Sopenharmony_ci
22253a5a1b3Sopenharmony_ci    pa_mutex_unlock(mx);
22353a5a1b3Sopenharmony_ci
22453a5a1b3Sopenharmony_ci    return m;
22553a5a1b3Sopenharmony_ci}
22653a5a1b3Sopenharmony_ci
22753a5a1b3Sopenharmony_civoid pa_memtrap_install(void) {
22853a5a1b3Sopenharmony_ci#ifdef HAVE_SIGACTION
22953a5a1b3Sopenharmony_ci    struct sigaction sa;
23053a5a1b3Sopenharmony_ci
23153a5a1b3Sopenharmony_ci    allocate_aupdate();
23253a5a1b3Sopenharmony_ci
23353a5a1b3Sopenharmony_ci    memset(&sa, 0, sizeof(sa));
23453a5a1b3Sopenharmony_ci    sa.sa_sigaction = signal_handler;
23553a5a1b3Sopenharmony_ci    sa.sa_flags = SA_RESTART|SA_SIGINFO;
23653a5a1b3Sopenharmony_ci
23753a5a1b3Sopenharmony_ci    pa_assert_se(sigaction(SIGBUS, &sa, NULL) == 0);
23853a5a1b3Sopenharmony_ci#ifdef __FreeBSD_kernel__
23953a5a1b3Sopenharmony_ci    pa_assert_se(sigaction(SIGSEGV, &sa, NULL) == 0);
24053a5a1b3Sopenharmony_ci#endif
24153a5a1b3Sopenharmony_ci#endif
24253a5a1b3Sopenharmony_ci}
243