1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
|
/******************************************************************************
*
* Copyright 2022 Google LLC
*
* 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.
*
******************************************************************************/
#include <stdint.h>
#include "lc3bin.h"
/**
* LC3 binary header
*/
#define LC3_FILE_ID (0x1C | (0xCC << 8))
struct lc3bin_header {
uint16_t file_id;
uint16_t header_size;
uint16_t srate_100hz;
uint16_t bitrate_100bps;
uint16_t channels;
uint16_t frame_10us;
uint16_t epmode;
uint16_t nsamples_low;
uint16_t nsamples_high;
};
/**
* Read LC3 binary header
*/
int lc3bin_read_header(FILE *fp,
int *frame_us, int *srate_hz, bool *hrmode, int *nchannels, int *nsamples)
{
struct lc3bin_header hdr;
uint16_t hdr_hrmode = 0;
if (fread(&hdr, sizeof(hdr), 1, fp) != 1
|| hdr.file_id != LC3_FILE_ID
|| hdr.header_size < sizeof(hdr))
return -1;
int num_extended_params = (hdr.header_size - sizeof(hdr)) / sizeof(uint16_t);
if (num_extended_params >= 1 &&
fread(&hdr_hrmode, sizeof(hdr_hrmode), 1, fp) != 1)
return -1;
*nchannels = hdr.channels;
*frame_us = hdr.frame_10us * 10;
*srate_hz = hdr.srate_100hz * 100;
*nsamples = hdr.nsamples_low | (hdr.nsamples_high << 16);
*hrmode = hdr_hrmode != 0;
if (hdr.epmode)
return -1;
fseek(fp, hdr.header_size, SEEK_SET);
return 0;
}
/**
* Read LC3 block of data
*/
int lc3bin_read_data(FILE *fp, int nchannels, void *buffer)
{
uint16_t nbytes;
if (fread(&nbytes, sizeof(nbytes), 1, fp) < 1
|| nbytes > nchannels * LC3_HR_MAX_FRAME_BYTES
|| fread(buffer, nbytes, 1, fp) < 1)
return -1;
return nbytes;
}
/**
* Write LC3 binary header
*/
void lc3bin_write_header(FILE *fp,
int frame_us, int srate_hz, bool hrmode,
int bitrate, int nchannels, int nsamples)
{
uint16_t hdr_hrmode = (hrmode != 0);
struct lc3bin_header hdr = {
.file_id = LC3_FILE_ID,
.header_size = sizeof(struct lc3bin_header) +
(hrmode ? sizeof(hdr_hrmode) : 0),
.srate_100hz = srate_hz / 100,
.bitrate_100bps = bitrate / 100,
.channels = nchannels,
.frame_10us = frame_us / 10,
.nsamples_low = nsamples & 0xffff,
.nsamples_high = nsamples >> 16,
};
fwrite(&hdr, sizeof(hdr), 1, fp);
if (hrmode)
fwrite(&hdr_hrmode, sizeof(hdr_hrmode), 1, fp);
}
/**
* Write LC3 block of data
*/
void lc3bin_write_data(FILE *fp, const void *data, int nbytes)
{
uint16_t hdr_nbytes = nbytes;
fwrite(&hdr_nbytes, sizeof(hdr_nbytes), 1, fp);
fwrite(data, 1, nbytes, fp);
}
|
