aboutsummaryrefslogtreecommitdiffstats
path: root/src/wavwriter.rs
blob: c0b324dc19215288151e3d500c4234ae99f9b5dd (plain) (blame)
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
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
extern crate nihav_core;

use nihav_core::io::byteio::*;
use nihav_core::frame::*;
use std::fs::File;
use std::io::SeekFrom;

pub struct WavWriter<'a> {
    io: Box<ByteWriter<'a>>,
    data_pos: u64,
    be: bool,
    bits: u8,
}

fn write_byte(wr: &mut ByteWriter, sample: u8) -> ByteIOResult<()> {
    wr.write_byte(sample)
}

fn write_s16(wr: &mut ByteWriter, sample: i16) -> ByteIOResult<()> {
    wr.write_u16le(sample as u16)
}

fn write_s32(wr: &mut ByteWriter, sample: i32) -> ByteIOResult<()> {
    wr.write_u16le((sample >> 16) as u16)
}

fn write_f32(wr: &mut ByteWriter, sample: f32) -> ByteIOResult<()> {
    let mut out = (sample * 32768.0) as i32;
    if out < -32768 { out = -32768; }
    if out >  32767 { out =  32767; }
    if out < 0 { out += 65536; }
    wr.write_u16le(out as u16)
}

macro_rules! write_data {
    ($wr:expr, $buf:expr, $write:ident) => ({
        let len = $buf.get_length();
        let ainfo = $buf.get_info();
        let nch = ainfo.get_channels() as usize;
        let mut offs: Vec<usize> = Vec::with_capacity(nch);
        for ch in 0..nch { offs.push($buf.get_offset(ch)); }
        let is_planar = $buf.get_step() == 1;
        let data = $buf.get_data();

        if is_planar {
            for i in 0..len {
                for ch in 0..nch {
                    let sample = data[offs[ch] + i];
                    $write($wr, sample)?;
                }
            }
        } else {
            for i in 0..len*nch {
                let sample = data[i];
                $write($wr, sample)?;
            }
        }
    })
}

impl<'a> WavWriter<'a> {
    pub fn new(name: &str) -> Self {
        let file = File::create(name).unwrap();
        let file = std::io::BufWriter::new(file);
        let fw   = Box::new(FileWriter::new_write(file));
        let io   = ByteWriter::new(Box::leak(fw));
        WavWriter { io: Box::new(io), data_pos: 0, be: false, bits: 0 }
    }
    pub fn write_header(&mut self, ainfo: NAAudioInfo) -> ByteIOResult<()> {
        let bits = ainfo.get_format().get_bits() as usize;

        self.io.write_buf(b"RIFF")?;
        self.io.write_u32le(0)?;
        self.io.write_buf(b"WAVE")?;

        self.io.write_buf(b"fmt ")?;
        self.io.write_u32le(16)?;
        self.io.write_u16le(0x0001)?; // PCM
        self.io.write_u16le(ainfo.get_channels() as u16)?;
        self.io.write_u32le(ainfo.get_sample_rate() as u32)?;

        if bits < 16 {
            self.io.write_u32le((ainfo.get_channels() as u32) * (ainfo.get_sample_rate() as u32))?;
            self.io.write_u16le(ainfo.get_channels() as u16)?; // block align
            self.io.write_u16le(8)?;
        } else {
            self.io.write_u32le(2 * (ainfo.get_channels() as u32) * (ainfo.get_sample_rate() as u32))?;
            self.io.write_u16le((2 * ainfo.get_channels()) as u16)?; // block align
            self.io.write_u16le(16)?;
        }

        self.io.write_buf(b"data")?;
        self.io.write_u32le(0)?;

        self.bits = bits as u8;
        self.be = ainfo.get_format().is_be();
        self.data_pos = self.io.tell();
        Ok(())
    }
    pub fn write_frame(&mut self, abuf: NABufferType) -> ByteIOResult<()> {
        match abuf {
            NABufferType::AudioU8(ref buf) => {
                write_data!(&mut self.io, buf, write_byte);
            }
            NABufferType::AudioI16(ref buf) => {
                write_data!(&mut self.io, buf, write_s16);
            }
            NABufferType::AudioI32(ref buf) => {
                write_data!(&mut self.io, buf, write_s32);
            }
            NABufferType::AudioF32(ref buf) => {
                write_data!(&mut self.io, buf, write_f32);
            }
            NABufferType::AudioPacked(ref buf) => {
                if !self.be || self.bits == 8 {
                    self.io.write_buf(buf.get_data().as_slice())?;
                } else {
                    let data = buf.get_data();
                    match self.bits {
                        16 => {
                            for samp in data.chunks(2) {
                                self.io.write_byte(samp[1])?;
                                self.io.write_byte(samp[0])?;
                            }
                        },
                        24 => {
                            for samp in data.chunks(3) {
                                self.io.write_byte(samp[2])?;
                                self.io.write_byte(samp[1])?;
                                self.io.write_byte(samp[0])?;
                            }
                        },
                        32 => {
                            for samp in data.chunks(4) {
                                self.io.write_byte(samp[3])?;
                                self.io.write_byte(samp[2])?;
                                self.io.write_byte(samp[1])?;
                                self.io.write_byte(samp[0])?;
                            }
                        },
                        _ => unimplemented!(),
                    };
                }
            }
            _ => {},
        };
        Ok(())
    }
}

impl<'a> Drop for WavWriter<'a> {
    #[allow(unused_variables)]
    fn drop(&mut self) {
        let size = self.io.tell();
        if (self.data_pos > 0) && (size >= self.data_pos) {
            let res = self.io.seek(SeekFrom::Start(4));
            let res = self.io.write_u32le((size - 8) as u32);
            let res = self.io.seek(SeekFrom::Start(self.data_pos - 4));
            let res = self.io.write_u32le(((size as u64) - self.data_pos) as u32);
            let res = self.io.flush();
        }
    }
}