mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-11-20 07:41:36 +08:00
90 lines
1.6 KiB
C++
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;
|
|
};
|
|
|
|
}
|
|
}
|