add SampleBuffer and ErrorManager; WAV testing
parent
04e23e9ad7
commit
e080a26651
@ -0,0 +1,85 @@
|
||||
/*
|
||||
ChibiOS - Copyright (C) 2006..2018 Giovanni Di Sirio
|
||||
|
||||
Licensed under the Apache License, Version 2.0 (the "License");
|
||||
you may not use this file except in compliance with the License.
|
||||
You may obtain a copy of the License at
|
||||
|
||||
http://www.apache.org/licenses/LICENSE-2.0
|
||||
|
||||
Unless required by applicable law or agreed to in writing, software
|
||||
distributed under the License is distributed on an "AS IS" BASIS,
|
||||
WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
See the License for the specific language governing permissions and
|
||||
limitations under the License.
|
||||
*/
|
||||
|
||||
/*
|
||||
* STM32L476xG memory setup.
|
||||
*/
|
||||
MEMORY
|
||||
{
|
||||
flash0 (rx) : org = 0x08000000, len = 1M
|
||||
flash1 (rx) : org = 0x00000000, len = 0
|
||||
flash2 (rx) : org = 0x00000000, len = 0
|
||||
flash3 (rx) : org = 0x00000000, len = 0
|
||||
flash4 (rx) : org = 0x00000000, len = 0
|
||||
flash5 (rx) : org = 0x00000000, len = 0
|
||||
flash6 (rx) : org = 0x00000000, len = 0
|
||||
flash7 (rx) : org = 0x00000000, len = 0
|
||||
ram0 (wx) : org = 0x20000000, len = 96k
|
||||
ram1 (wx) : org = 0x00000000, len = 0
|
||||
ram2 (wx) : org = 0x00000000, len = 0
|
||||
ram3 (wx) : org = 0x00000000, len = 0
|
||||
ram4 (wx) : org = 0x10000000, len = 0 /* Save 32k for ELF load */
|
||||
ram5 (wx) : org = 0x00000000, len = 0
|
||||
ram6 (wx) : org = 0x00000000, len = 0
|
||||
ram7 (wx) : org = 0x00000000, len = 0
|
||||
}
|
||||
|
||||
/* For each data/text section two region are defined, a virtual region
|
||||
and a load region (_LMA suffix).*/
|
||||
|
||||
/* Flash region to be used for exception vectors.*/
|
||||
REGION_ALIAS("VECTORS_FLASH", flash0);
|
||||
REGION_ALIAS("VECTORS_FLASH_LMA", flash0);
|
||||
|
||||
/* Flash region to be used for constructors and destructors.*/
|
||||
REGION_ALIAS("XTORS_FLASH", flash0);
|
||||
REGION_ALIAS("XTORS_FLASH_LMA", flash0);
|
||||
|
||||
/* Flash region to be used for code text.*/
|
||||
REGION_ALIAS("TEXT_FLASH", flash0);
|
||||
REGION_ALIAS("TEXT_FLASH_LMA", flash0);
|
||||
|
||||
/* Flash region to be used for read only data.*/
|
||||
REGION_ALIAS("RODATA_FLASH", flash0);
|
||||
REGION_ALIAS("RODATA_FLASH_LMA", flash0);
|
||||
|
||||
/* Flash region to be used for various.*/
|
||||
REGION_ALIAS("VARIOUS_FLASH", flash0);
|
||||
REGION_ALIAS("VARIOUS_FLASH_LMA", flash0);
|
||||
|
||||
/* Flash region to be used for RAM(n) initialization data.*/
|
||||
REGION_ALIAS("RAM_INIT_FLASH_LMA", flash0);
|
||||
|
||||
/* RAM region to be used for Main stack. This stack accommodates the processing
|
||||
of all exceptions and interrupts.*/
|
||||
REGION_ALIAS("MAIN_STACK_RAM", ram0);
|
||||
|
||||
/* RAM region to be used for the process stack. This is the stack used by
|
||||
the main() function.*/
|
||||
REGION_ALIAS("PROCESS_STACK_RAM", ram0);
|
||||
|
||||
/* RAM region to be used for data segment.*/
|
||||
REGION_ALIAS("DATA_RAM", ram0);
|
||||
REGION_ALIAS("DATA_RAM_LMA", flash0);
|
||||
|
||||
/* RAM region to be used for BSS segment.*/
|
||||
REGION_ALIAS("BSS_RAM", ram0);
|
||||
|
||||
/* RAM region to be used for the default heap.*/
|
||||
REGION_ALIAS("HEAP_RAM", ram0);
|
||||
|
||||
/* Generic rules inclusion.*/
|
||||
INCLUDE rules.ld
|
||||
@ -0,0 +1,95 @@
|
||||
#ifndef WAV_HPP_
|
||||
#define WAV_HPP_
|
||||
|
||||
#include <cstdint>
|
||||
#include <cstring>
|
||||
#include <fstream>
|
||||
|
||||
namespace wav
|
||||
{
|
||||
struct header {
|
||||
char riff[4]; // "RIFF"
|
||||
uint32_t filesize; // Total file size minus eight bytes
|
||||
char wave[4]; // "WAVE"
|
||||
|
||||
bool valid() const {
|
||||
return strncmp(riff, "RIFF", 4) == 0 && filesize > 8 && strncmp(wave, "WAVE", 4) == 0;
|
||||
}
|
||||
} __attribute__ ((packed));
|
||||
|
||||
struct format {
|
||||
char fmt_[4]; // "fmt "
|
||||
uint32_t size;
|
||||
uint16_t type;
|
||||
uint16_t channelcount;
|
||||
uint32_t samplerate;
|
||||
uint32_t byterate;
|
||||
uint16_t unused;
|
||||
uint16_t bps;
|
||||
|
||||
bool valid() const {
|
||||
return strncmp(fmt_, "fmt ", 4) == 0;
|
||||
}
|
||||
} __attribute__ ((packed));
|
||||
|
||||
struct data {
|
||||
char data[4]; // "data"
|
||||
uint32_t size;
|
||||
|
||||
bool valid() const {
|
||||
return strncmp(data, "data", 4) == 0;
|
||||
}
|
||||
} __attribute__ ((packed));
|
||||
|
||||
class clip {
|
||||
public:
|
||||
clip(const char *path) {
|
||||
std::ifstream file (path);
|
||||
if (!file.good())
|
||||
return;
|
||||
{
|
||||
header h;
|
||||
file.read(reinterpret_cast<char *>(&h), sizeof(header));
|
||||
if (!h.valid())
|
||||
return;
|
||||
}
|
||||
{
|
||||
format f;
|
||||
file.read(reinterpret_cast<char *>(&f), sizeof(format));
|
||||
if (!f.valid() || f.type != 1) // ensure PCM
|
||||
return;
|
||||
}
|
||||
{
|
||||
wav::data d;
|
||||
file.read(reinterpret_cast<char *>(&d), sizeof(wav::data));
|
||||
if (!d.valid())
|
||||
return;
|
||||
m_data = new char[d.size + 4096 - (d.size % 4096)];
|
||||
m_size = d.size;
|
||||
file.read(m_data, d.size);
|
||||
}
|
||||
}
|
||||
|
||||
bool valid() const {
|
||||
return m_data != nullptr && m_size > 0;
|
||||
}
|
||||
auto data() const {
|
||||
return m_data;
|
||||
}
|
||||
auto next(unsigned int chunksize = 3000) {
|
||||
if (m_pos == m_size) {
|
||||
m_pos = 0;
|
||||
}
|
||||
auto ret = m_data + m_pos;
|
||||
m_pos = std::min(m_pos + chunksize, m_size);
|
||||
return ret;
|
||||
}
|
||||
private:
|
||||
char *m_data = nullptr;
|
||||
uint32_t m_size = 0;
|
||||
uint32_t m_pos = 0;
|
||||
};
|
||||
}
|
||||
|
||||
#endif // WAV_HPP_
|
||||
|
||||
@ -0,0 +1,56 @@
|
||||
#include <array>
|
||||
#include <cstdint>
|
||||
|
||||
constexpr unsigned int MAX_SAMPLE_BUFFER_SIZE = 6000;
|
||||
|
||||
using Sample = uint16_t;
|
||||
|
||||
class SampleBuffer
|
||||
{
|
||||
public:
|
||||
void clear() {
|
||||
m_buffer.fill(0);
|
||||
}
|
||||
void modify(Sample *data, unsigned int srcsize) {
|
||||
auto size = srcsize < m_size ? srcsize : m_size;
|
||||
std::copy(data, data + size, m_buffer.data());
|
||||
m_modified = m_buffer.data();
|
||||
}
|
||||
void midmodify(Sample *data, unsigned int srcsize) {
|
||||
auto size = srcsize < m_size / 2 ? srcsize : m_size / 2;
|
||||
std::copy(data, data + size, middata());
|
||||
m_modified = middata();
|
||||
}
|
||||
|
||||
void setSize(unsigned int size) {
|
||||
m_size = size < MAX_SAMPLE_BUFFER_SIZE ? size : MAX_SAMPLE_BUFFER_SIZE;
|
||||
}
|
||||
|
||||
Sample *data() /*const*/ {
|
||||
return m_buffer.data();
|
||||
}
|
||||
Sample *middata() /*const*/ {
|
||||
return m_buffer.data() + m_size / 2;
|
||||
}
|
||||
uint8_t *bytedata() /*const*/ {
|
||||
return reinterpret_cast<uint8_t *>(m_buffer.data());
|
||||
}
|
||||
|
||||
Sample *modified() {
|
||||
auto m = m_modified;
|
||||
m_modified = nullptr;
|
||||
return m;
|
||||
}
|
||||
unsigned int size() const {
|
||||
return m_size;
|
||||
}
|
||||
unsigned int bytesize() const {
|
||||
return m_size * sizeof(Sample);
|
||||
}
|
||||
|
||||
private:
|
||||
std::array<Sample, MAX_SAMPLE_BUFFER_SIZE> m_buffer;
|
||||
unsigned int m_size = MAX_SAMPLE_BUFFER_SIZE;
|
||||
Sample *m_modified = nullptr;
|
||||
};
|
||||
|
||||
@ -0,0 +1,38 @@
|
||||
#include <array>
|
||||
|
||||
constexpr unsigned int MAX_ERROR_QUEUE_SIZE = 8;
|
||||
|
||||
enum class Error : char
|
||||
{
|
||||
None = 0,
|
||||
BadParam,
|
||||
BadParamSize,
|
||||
BadUserCodeLoad,
|
||||
BadUserCodeSize,
|
||||
NotIdle,
|
||||
ConversionAborted
|
||||
};
|
||||
|
||||
class ErrorManager
|
||||
{
|
||||
public:
|
||||
void add(Error error) {
|
||||
if (m_index < m_queue.size())
|
||||
m_queue[m_index++] = error;
|
||||
}
|
||||
|
||||
bool assert(bool condition, Error error) {
|
||||
if (!condition)
|
||||
add(error);
|
||||
return condition;
|
||||
}
|
||||
|
||||
Error pop() {
|
||||
return m_index == 0 ? Error::None : m_queue[--m_index];
|
||||
}
|
||||
|
||||
private:
|
||||
std::array<Error, MAX_ERROR_QUEUE_SIZE> m_queue;
|
||||
unsigned int m_index = 0;
|
||||
};
|
||||
|
||||
Loading…
Reference in New Issue