2016-02-10 01:49:17 +00:00
|
|
|
/*
|
|
|
|
* Copyright (C) 2016 Jared Boone, ShareBrained Technology, Inc.
|
|
|
|
*
|
|
|
|
* This file is part of PortaPack.
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License as published by
|
|
|
|
* the Free Software Foundation; either version 2, or (at your option)
|
|
|
|
* any later version.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
* GNU General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program; see the file COPYING. If not, write to
|
|
|
|
* the Free Software Foundation, Inc., 51 Franklin Street,
|
|
|
|
* Boston, MA 02110-1301, USA.
|
|
|
|
*/
|
|
|
|
|
2016-04-22 19:15:51 +00:00
|
|
|
#ifndef __CAPTURE_THREAD_H__
|
|
|
|
#define __CAPTURE_THREAD_H__
|
2016-02-10 01:49:17 +00:00
|
|
|
|
|
|
|
#include "ch.h"
|
|
|
|
|
|
|
|
#include "file.hpp"
|
|
|
|
|
|
|
|
#include "event_m0.hpp"
|
|
|
|
|
|
|
|
#include "portapack_shared_memory.hpp"
|
|
|
|
|
|
|
|
#include "hackrf_gpio.hpp"
|
|
|
|
using namespace hackrf::one;
|
|
|
|
|
|
|
|
#include <cstring>
|
|
|
|
|
|
|
|
class StreamOutput {
|
|
|
|
public:
|
2016-04-27 05:26:30 +00:00
|
|
|
StreamOutput(
|
|
|
|
const size_t write_size_log2,
|
|
|
|
const size_t buffer_count_log2
|
|
|
|
) : config { write_size_log2, buffer_count_log2 }
|
|
|
|
{
|
2016-04-23 22:07:44 +00:00
|
|
|
shared_memory.baseband_queue.push_and_wait(
|
|
|
|
CaptureConfigMessage { &config }
|
|
|
|
);
|
2016-04-27 05:26:30 +00:00
|
|
|
fifo = config.fifo;
|
2016-04-23 22:07:44 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
~StreamOutput() {
|
2016-04-27 05:26:30 +00:00
|
|
|
fifo = nullptr;
|
2016-04-23 22:07:44 +00:00
|
|
|
shared_memory.baseband_queue.push_and_wait(
|
|
|
|
CaptureConfigMessage { nullptr }
|
|
|
|
);
|
2016-02-10 01:49:17 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
size_t available() {
|
2016-04-23 22:07:44 +00:00
|
|
|
return config.fifo->len();
|
2016-02-10 01:49:17 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
size_t read(void* const data, const size_t length) {
|
2016-04-23 22:07:44 +00:00
|
|
|
return config.fifo->out(reinterpret_cast<uint8_t*>(data), length);
|
2016-02-10 01:49:17 +00:00
|
|
|
}
|
|
|
|
|
2016-04-27 05:26:30 +00:00
|
|
|
static FIFO<uint8_t>* fifo;
|
|
|
|
|
2016-02-10 01:49:17 +00:00
|
|
|
private:
|
2016-04-23 22:07:44 +00:00
|
|
|
CaptureConfig config;
|
2016-02-10 01:49:17 +00:00
|
|
|
};
|
|
|
|
|
2016-04-22 19:15:51 +00:00
|
|
|
class CaptureThread {
|
2016-02-10 01:49:17 +00:00
|
|
|
public:
|
2016-04-22 19:15:51 +00:00
|
|
|
CaptureThread(
|
2016-04-27 05:26:30 +00:00
|
|
|
std::string file_path,
|
|
|
|
size_t write_size_log2,
|
|
|
|
size_t buffer_count_log2
|
|
|
|
) : write_size_log2 { write_size_log2 },
|
|
|
|
write_size { 1U << write_size_log2 },
|
|
|
|
buffer_count_log2 { buffer_count_log2 },
|
|
|
|
file_path { std::move(file_path) }
|
2016-02-10 01:49:17 +00:00
|
|
|
{
|
|
|
|
// Need significant stack for FATFS
|
2016-04-22 19:15:51 +00:00
|
|
|
thread = chThdCreateFromHeap(NULL, 1024, NORMALPRIO + 10, CaptureThread::static_fn, this);
|
2016-02-10 01:49:17 +00:00
|
|
|
}
|
|
|
|
|
2016-04-22 19:15:51 +00:00
|
|
|
~CaptureThread() {
|
2016-04-23 22:07:44 +00:00
|
|
|
const auto thread_tmp = thread;
|
2016-04-06 18:47:25 +00:00
|
|
|
|
2016-04-23 22:07:44 +00:00
|
|
|
if( thread_tmp ) {
|
|
|
|
thread = nullptr;
|
|
|
|
chThdTerminate(thread_tmp);
|
2016-04-24 00:28:31 +00:00
|
|
|
chEvtSignal(thread_tmp, EVT_MASK_CAPTURE_THREAD);
|
2016-04-23 22:07:44 +00:00
|
|
|
const auto success = chThdWait(thread_tmp);
|
|
|
|
|
|
|
|
if( !success ) {
|
|
|
|
led_tx.on();
|
|
|
|
}
|
2016-04-06 18:47:25 +00:00
|
|
|
}
|
2016-02-10 01:49:17 +00:00
|
|
|
}
|
|
|
|
|
2016-03-28 05:49:30 +00:00
|
|
|
static void check_fifo_isr() {
|
2016-04-23 22:07:44 +00:00
|
|
|
// TODO: Prevent over-signalling by transmitting a set of
|
|
|
|
// flags from the baseband core.
|
2016-04-27 05:26:30 +00:00
|
|
|
const auto fifo = StreamOutput::fifo;
|
|
|
|
if( fifo ) {
|
2016-04-24 00:28:31 +00:00
|
|
|
chEvtSignalI(thread, EVT_MASK_CAPTURE_THREAD);
|
2016-03-28 05:49:30 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-02-10 01:49:17 +00:00
|
|
|
private:
|
2016-04-27 05:26:30 +00:00
|
|
|
const size_t write_size_log2;
|
|
|
|
const size_t write_size;
|
|
|
|
const size_t buffer_count_log2;
|
2016-04-06 22:00:22 +00:00
|
|
|
const std::string file_path;
|
2016-02-10 01:49:17 +00:00
|
|
|
File file;
|
|
|
|
static Thread* thread;
|
|
|
|
|
|
|
|
static msg_t static_fn(void* arg) {
|
2016-04-22 19:15:51 +00:00
|
|
|
auto obj = static_cast<CaptureThread*>(arg);
|
2016-04-06 18:47:25 +00:00
|
|
|
return obj->run();
|
2016-02-10 01:49:17 +00:00
|
|
|
}
|
|
|
|
|
2016-04-06 18:47:25 +00:00
|
|
|
msg_t run() {
|
2016-04-20 17:24:39 +00:00
|
|
|
if( !file.open_for_writing(file_path) ) {
|
2016-04-06 22:00:22 +00:00
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2016-04-27 05:26:30 +00:00
|
|
|
const auto write_buffer = std::make_unique<uint8_t[]>(write_size);
|
|
|
|
if( !write_buffer ) {
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
|
|
|
StreamOutput stream { write_size_log2, buffer_count_log2 };
|
2016-02-10 01:49:17 +00:00
|
|
|
|
2016-04-06 18:52:05 +00:00
|
|
|
while( !chThdShouldTerminate() ) {
|
2016-04-27 17:12:21 +00:00
|
|
|
if( stream.available() >= write_size ) {
|
2016-04-06 18:52:05 +00:00
|
|
|
if( !transfer(stream, write_buffer.get()) ) {
|
|
|
|
return false;
|
|
|
|
}
|
2016-04-27 17:12:21 +00:00
|
|
|
} else {
|
|
|
|
chEvtWaitAny(EVT_MASK_CAPTURE_THREAD);
|
2016-04-06 18:35:00 +00:00
|
|
|
}
|
|
|
|
}
|
2016-04-06 18:52:05 +00:00
|
|
|
|
|
|
|
return true;
|
2016-04-06 18:35:00 +00:00
|
|
|
}
|
|
|
|
|
2016-04-27 05:26:30 +00:00
|
|
|
bool transfer(StreamOutput& stream, uint8_t* const write_buffer) {
|
2016-04-06 18:35:00 +00:00
|
|
|
bool success = false;
|
2016-02-10 01:49:17 +00:00
|
|
|
|
2016-04-06 18:35:00 +00:00
|
|
|
led_usb.on();
|
2016-02-10 01:49:17 +00:00
|
|
|
|
2016-04-27 05:26:30 +00:00
|
|
|
const auto bytes_to_write = stream.read(write_buffer, write_size);
|
|
|
|
if( bytes_to_write == write_size ) {
|
|
|
|
if( file.write(write_buffer, write_size) ) {
|
2016-04-06 18:35:00 +00:00
|
|
|
success = true;
|
2016-02-10 01:49:17 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-04-06 18:35:00 +00:00
|
|
|
led_usb.off();
|
|
|
|
|
|
|
|
return success;
|
2016-02-10 01:49:17 +00:00
|
|
|
}
|
|
|
|
};
|
|
|
|
|
2016-04-22 19:15:51 +00:00
|
|
|
#endif/*__CAPTURE_THREAD_H__*/
|