Files
PX4-Autopilot/src/modules/logger/log_writer.h
T

90 lines
1.6 KiB
C++

#pragma once
#include <px4.h>
#include <stdint.h>
#include <pthread.h>
#include <drivers/drv_hrt.h>
#include <systemlib/perf_counter.h>
namespace px4
{
namespace logger
{
class LogWriter
{
friend class Logger;
public:
LogWriter(size_t buffer_size);
~LogWriter();
bool init();
/**
* start the thread
* @param thread will be set to the created thread on success
* @return 0 on success, error number otherwise (@see pthread_create)
*/
int thread_start(pthread_t &thread);
void thread_stop();
void start_log(const char *filename);
void stop_log();
/**
* Write data to be logged. The caller must call lock() before calling this.
* @return true on success, false if not enough space in the buffer left
*/
bool write(void *ptr, size_t size);
void lock()
{
pthread_mutex_lock(&_mtx);
}
void unlock()
{
pthread_mutex_unlock(&_mtx);
}
void notify()
{
pthread_cond_broadcast(&_cv);
}
private:
static void *run_helper(void *);
void run();
size_t get_read_ptr(void **ptr, bool *is_part);
void mark_read(size_t n)
{
_count -= n;
}
/* 512 didn't seem to work properly, 4096 should match the FAT cluster size */
static constexpr size_t _min_write_chunk = 4096;
char _filename[64];
int _fd;
uint8_t *_buffer = nullptr;
const size_t _buffer_size;
size_t _head = 0; ///< next position to write to
size_t _count = 0; ///< number of bytes in _buffer to be written
size_t _total_written = 0;
bool _should_run = false;
bool _running = false;
bool _exit_thread = false;
pthread_mutex_t _mtx;
pthread_cond_t _cv;
perf_counter_t perf_write;
perf_counter_t perf_fsync;
};
}
}