kopia lustrzana https://github.com/markondej/fm_transmitter
61 wiersze
2.4 KiB
C++
61 wiersze
2.4 KiB
C++
/*
|
|
FM Transmitter - use Raspberry Pi as FM transmitter
|
|
|
|
Copyright (c) 2020, Marcin Kondej
|
|
All rights reserved.
|
|
|
|
See https://github.com/markondej/fm_transmitter
|
|
|
|
Redistribution and use in source and binary forms, with or without modification, are
|
|
permitted provided that the following conditions are met:
|
|
|
|
1. Redistributions of source code must retain the above copyright notice, this list
|
|
of conditions and the following disclaimer.
|
|
|
|
2. Redistributions in binary form must reproduce the above copyright notice, this
|
|
list of conditions and the following disclaimer in the documentation and/or other
|
|
materials provided with the distribution.
|
|
|
|
3. Neither the name of the copyright holder nor the names of its contributors may be
|
|
used to endorse or promote products derived from this software without specific
|
|
prior written permission.
|
|
|
|
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY
|
|
EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT
|
|
SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
|
|
TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
|
|
BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY
|
|
WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
#include "sample.hpp"
|
|
#include <climits>
|
|
|
|
Sample::Sample(uint8_t *data, unsigned channels, unsigned bitsPerChannel)
|
|
: value(0.f)
|
|
{
|
|
int sum = 0;
|
|
int16_t *channelValues = new int16_t[channels];
|
|
for (unsigned i = 0; i < channels; i++) {
|
|
switch (bitsPerChannel >> 3) {
|
|
case 2:
|
|
channelValues[i] = (data[((i + 1) << 1) - 1] << 8) | data[((i + 1) << 1) - 2];
|
|
break;
|
|
case 1:
|
|
channelValues[i] = (static_cast<int16_t>(data[i]) - 0x80) << 8;
|
|
break;
|
|
}
|
|
sum += channelValues[i];
|
|
}
|
|
value = 2 * sum / (static_cast<float>(USHRT_MAX) * channels);
|
|
delete[] channelValues;
|
|
}
|
|
|
|
float Sample::GetMonoValue() const
|
|
{
|
|
return value;
|
|
}
|